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FOREWORD 


This  Is  the  final  report  on-  the  Guidance/Navigation  Requirements  Study 
(G/NRS),  which  was  performed  for  SAMSO,  Air  Force  Systems  Command,  USAF, 
under  contract  F04701-75-C-0112  by  Loglcon,  Inc.  The  study  was  Initiated 
In  May  of  1975  and  completed  In  April  of  1978. 

General  G/NRS  objectives  were  twofold: 

1)  To  develop  and  maintain  performance  models  for  both  flight 
test  and  operational  versions  of  an  Air  Force  Maneuvering 
Reentry  Vehicle. 

2)  To  use  these  models  to  assist  the  Air  Force  In  establishing 
G/N  subsystem  requirements  and  options  for  a flight  test 
vehicle  and  Investigate  the  performance  of  an  operational 
MaRV. 

This  report  Is  segmented  Into  three  volumes.  Volume  I presents  an  over- 
view of  the  reentry  system  performance  analysis  problem  and  summarizes  the 
results  of  the  entire  effort.  Volume  II  corroborates  the  summary  pre- 
sented In  Volume  I with  documentation  of  the  detailed  analysis  performed 
during  the  course  of  the  study.  Volume  III  contains  appendices  which  des- 
cribe In  detail  the  salient  analysis  techniques  employed  during  the  study. 

loglcon  wishes  to  acknowledge  valuable  technical  assistance  provided 
by  the  principal  Air  Force  and  Aerospace  participants:  Major  J.  T. 

Pearson  and  Capt.  0.  A.  Davis  and  Messrs.  P.  Kruh  and  H.  E.  Whiteside  and 
Dr.  r.  0.  Rogers.  The  authors  of  Volume  III  are  Messrs.  S.  M.  Archer, 
and  E.  F.  Nicholson,  and  Drs.  C.  L.  Bowman,  D.  D.  Sworder,  and  S.  B. 
Vidor.  Programming  support  was  provided  by  Dr.  F.  A.  Rohatsch. 
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APPENDIX  A. 

IMU  PERFORMANCE  MODELING  AND  EVALUATION 


A mathematical  description  of  the  errors  Inherent  In  utilizing 
a sensor  capable  of  measuring  the  non-gravitatlonal  acceleration  in  a 
navigation  system  Is  described  In  this  appendix.  The  discussion  Is  divided 
Into  three  segments.  The  first  pertains  to  the  errors  In  the  navigated 
state  produced  by  a general  acceleration  measurement  error.  The  second  seg- 
ment discusses  the  sources  of  the  error  in  the  measured  acceleration.  The 
third  segment  addresses  statistical  processing  of  the  calculated  navigation 
error  to  obtain  deployment  errors,  target  miss,  etc. 

A- 1 . NAVIGATED  STATE  ERRORS 

A linear  analysis  of  the  navigation  errors  associated  with  In- 
accurate acceleration  measurement  considers  the  following  differential 
equation  Involving  the  navigated  state: 


j 2—  .. 

2-y  ■ r ■ g (?)  + a 
dr 


(A-l) 


where 

a Is  the  acceleration  sensed  by  the  navigation  system 
g\r)  Is  the  gravitational  acceleration 
r Is  the  position  component  of  the  navigated  state. 


To  obtain  an  equation  relating  small  errors  in  the  acceleration 
terms  to  position  errors,  let 


LOGICON 


where 


are  the  nominal  position  and  acceleration  (measured 
and  gravitational)  along  the  phase  space  profile 


are  perturbations  In  position  and  acceleration. 


Substituting  (A-2)  into  (A-l),  expanding  and  rearranging: 

(?N  - 0N(r)  - aN  j + Sr  - dr  • 7dg(?)  ■ dg (r)  + da 

(A-3) 

Products  of  perturbations  have  been  Ignored.  Note  that  the  parenthetical 
term  in  Equation  A-3  Is  the  differential  equation  describing  the  profile, 
and  Is  therefore  zero. 


Considering  a spherical  earth  gravitation  field  for  the  g(r) 
term,  Equation  A-3  becomes 


dr  + 


3 r. 


dr 


i^r 


da  + dg(r) 


(A-4) 


This  differential  equation  which  relates  the  error  in  the  navigated  position 
to  errors  in  the  measured  and  gravitational  acceleration  can  be  numerically 
solved  to  obtain  the  navigation  system  errors. 


The  forcing  functions  (da  and  dg(r))  represent  the  errors  inher- 
ent In  the  measurement  of  the  Inflight  acceleration  and  the  computation 
of  the  gravitational  acceleration. 


The  Solution  to  Equation  A-4  yields  the  position  error 
associated  with  an  acceleration  measurement  error.  If  the  velocity 
error  Is  also  desired,  two  first-order  equations  can  be  formulated 
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from  Equation  A-4  by  the  substitution  *Sv  * Jr.  The  two  resulting  equations 
can  be  solved  and  6v  and  6r  determined. 

A-2.  ACCELERATION  MEASUREMENT  ERRORS 


The  errors  In  the  acceleration  measured  by  the  navigation  sensing 
unit  are  discussed  in  this  section.  The  section  is  segmented  Into  three 
segments,  each  of  which  describes  a different  source  of  the  acceleration 
measurement  error.  The  first  segment  discusses  the  measurement  errors 
associated  with  the  accelerometers,  which  measure  the  non-gravitatlonal 
acceleration  along  their  sensitive  axis.  The  second  segment  formulates 
the  effect  that  gyro  errors  have  on  determining  the  orientation  of  the 
accelerometer  sensitive  axes  relative  to  a known  computational  frame. 

The  third  segment  demonstrates  some  of  the  effects  structural  compliance 
has  on  the  transformation  of  the  measured  acceleration  in  accelerometer 
coordinates  to  navigation  computation  coordinates. 

A-2,1  ACCELEROMETER  ERRORS 

The  errors  Inherent  in  the  actual  measurement  of  the  non- 
gravitatlonal  acceleration  are  modeled  as  an  acceleration  error  along 
each  of  the  accelerometer  sensitive  axes.  This  error  is  then  transformed 
into  computational  coordinates  utilizing  the  accelerometer  to  navigation 
frame  transformation  which  describes  the  geometry  and  orientation  of 
the  accelerometer  cluster.  This  transformed  error  can  then  be  handled 
as  described  in  Section  A-l. 

The  equation  performing  the  above  is 

M 

SSN  ■ 5a,  [ATN]I  j 


where 


iSa^  ■ acceleration  error  in  navigation  coordinates 


A-3 


[ATN]  = accelerometer  to  navigation  transformation  (may  be 
time-varying) 

6a.  « magnitude  of  the  acceleration  error  for  the  ith 

accelerometer 

6^ j ■ Kronecker  delta  function 

The  acceleration  error  magnitude  may  be  from  several  sources  Including 
bias  errors,  scale  factor  errors,  misalignments  and  quantization. 


For  example,  If  a particular  orthogonal  accelerometer  cluster 
was  Inertial ly  held  and  the  accelerometer  errors  were  modeled  as  bias 
and  scale  factor  errors,  the  modeling  equations  would  be: 


[ATN]  I 0 
\0 


(° 

[ATN]  b. 


/° 

[ATN]  0 


saN  - S [ATN]!  0 


«INg  - Sy[ATN]^0' 


«aNg  » Sz[ATN]l  0 


1’ :V' 
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where 


bx,  by,  bz 
S X » Sy  , S 2 


a , a , a 
x'  y*  z 


<Sa 


are  the  bias  errors 

are  the  scale  factor  errors 

are  the  acceleration  components  along  the 
accelerometer  sensitive  axis  of  the  x,  y, 
and  2 accelerometers 

is  the  1th  error  In  navigation  acceleration. 


Each  <5aN  is  treated  separately  (I.e.,  a <5?^  and  fv^  Integrated  for  each 
of  the  six  errors)  to  determine  the  miss  associated  with  each  error  source. 

A- 2. 2 GYRO  ERRORS 


The  error  caused  by  the  gyros  In  the  transformation  of  the  accel- 
eration measured  by  the  accelerometer  cluster  into  the  navigation  frame  is 
discussed  In  this  section.  The  errors  arise  due  to  the  drift  of  the  gyro 
stabilized  reference  frame,  which  may  either  be  an  actual  inertial ly-stable 
structure  of  a computational  reference  derived  from  rate  (or  angle  incre- 
ment) measurements  by  the  gyros.  In  either  case,  the  acceleration  error 
can  be  calculated  from  an  accumulated  misalignment  caused  by  gyro  drift. 

The  acceleration  error  associated  with  gyro  drift  is  represented 

by: 

SaN  - Qs>][ATN]  aA  - aN 

where 

[$]  Is  the  gyro  derived  misalignment  matrix 

a’A  is  the  acceleration  measured  In  accelerometer  coordinates 

a^  is  the  acceleration  computed  in  navigation  coordinates 
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The  gyro-derived  misalignment  is  the  first  integral  of  the  gyro  drift 
rate,  which  is  expressed  as: 

6“^l  * [GTN] 

where 

[GTN]  is  the  gyro-to-navlgation  transformation  (either 
a constant  or  an  integral  of  the  gyro  rate) 

6SJq  is  the  error  In  the  rate  about  the  gyro  input 
axes 

The  derivative  of  [$]  is 

[♦]  “ (%]  [♦] 


where 

m 

is  the  cross  product  matrix 

' 0 
Hz 

-Si 

0 

Sy‘ 

‘Sx 

.“Hy 

Sx 

0 

m 

Note  that  if,  initially,  [4>(0)]  " [l]t  then 

[<f>(t)]  is  of  the  form  [l]+  j^f ( 6asN ) J 

where  jV ( 653^ ) J represents  the  contribution  of  the  H to  [0]  at  time  t. 
However,  if  products  of  terms  Involving  <5CN  are  ignored 

[*]  " [h](W  + [f(6aN)]) 

Ci]  ■ [h]  + ^ 

and 

[♦(t)]  " f [$wn(t)J  dT+  [,(0)] 

0 
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Thus,  the  misalignment  of  the  accelerometer-to-navigation  transformation 
can  be  computed  from  the  drift  rate  errors  associated  with  the  gyros. 

For  example,  consider  a constant  fixed  drift  error  of  an  ortho- 
gonal triad  of  initlally-stable  single  degree-of- freedom  gyros  coincident 
with  the  navigation  coordinate  frame.  In  this  case 

♦ j • D1 

where 

$.  ■ the  drift  rate  of  the  1th  gyro 

D.|  ■ the  fixed  drift  coefficient  of  the  ith  gyro 

Therefore, 


and 
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A-2.3  STRUCTURAL  COMPLIANCE 


This  discussion  of  the  structural  compliance  Is  not  detailed  or 
Involved.  Basically,  only  the  effect  of  the  compliance  of  the  accelerometer 
relative  to  the  navigation  frame  Is  considered.  It  Is  recognized  that  this 
Is  only  one  compliance  out  of  many  which  exist  but  the  Ideas  presented  re- 
garding the  treatment  of  accelerometer  bending  can  be  applied  to  other 
bending  modes  as  well. 

Essentially,  all  structural  compliance  of  the  mounting  frame 
of  the  platform  results  In  the  accelerometer  sensitive  axes  oriented  In 
an  unknown  direction.  The  misalignment  can  be  considered  small  and  modeled 
as  follows 


" C1jkajak 
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where 


6a, 


C 


ijk 


ajak 


is  the  error  of  the  ith  accelerometer  measurement 
due  to  structural  compliance 

is  the  coefficient  of  bending  of  the  1th  accel- 
erometer sensitive  axis  toward  the  jth  direction 
by  acceleration  along  the  kth  direction 

acceleration  components. 


Depending  upon  the  test  data  available,  aj  and  ak  above  may  be  platform 
accelerations  or  accelerometer  accelerations.  The  acceleration  error 
6a.|  Is  treated  In  exactly  the  same  way  as  in  Section  A-2.1. 

A-3.  STATISTICAL  PROCESSING 


The  processing  of  the  position  and  velocity  errors  calculated 
In  Section  A-l  Is  discussed  In  this  section.  Included  will  be  the  pro- 
pagation of  the  Integrated  position  and  velocity  errors  into  CEP. 


The  position  and  velocity  errors  determined  as  described  In  Sec- 
tion A-l  for  each  of  the  error  sources  types  discussed  In  Section  A-2  re- 
present a 6 X N matrix  (where  N represents  the  number  of  error  terms). 

This  matrix  will  be  denoted  ||-  , as  It  reflects  the  sensitivity  of  state 

S 

(position  and  velocity)  to  unit  error  source  magnitudes,  1 . e. » 


where 


3S 

*5 


X ! 5*2  ! 


6R. 


1 


67, 


^1  ) are  the  position  and  velocity  errors 

6V,j  ) associated  with  the  1th  error 


It  Is  Important  to  note  that  as  a direct  result  of  the  linearization  of 

the  error  equations  presented  In  Section  A-l*  gg-  Is  linear.  That  Is, 
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If  a particular  error  coefficient  doubles,  the  state  error  associated  with 

gc 

that  error  also  doubles.  Thus  |jf-  is  a linear  mapping  of  error  sources 
Into  state  errors*  1 .e. , 


5S  ' ttj  5ES 


The  differential  equation  stated  In  Section  A-l  can  be  solved  along  any 

gc 

nominal  path  to  produce  a at  any  point  along  the  trajectory.  Given 


this  sensitivity,  the  miss  associated  with  that  trajectory  point  can  be 
calculated  from  the  above  equation  for  6S.  For  example  the  covariance 
of  iSS  Is 


As  ■ E(SSSST)  • |f-  E(SEsiE$T)  ||I 
. . 3S  . SST 


where 

Aa  represents  covariance  of  a 
E(  ) represents  expectation 


Given  the  covariance  of  the  state  errors,  statistical  quantities  such  as 
CEP  can  be  calculated. 


gc 

For  example,  If  the  CEP  Is  desired,  must  be  calculated 

from  navigation  Initiation  to  Impact.  The  covariance  of  the  state  error 
Is  now  determined  from  the  covariance  of  the  error  sources.  The  state 
covariance  can  now  be  mapped  Into  a downrange,  crossrange  time  coordinate 
frame  by  an  orthogonal  rotation  followed  by  a projection  of  the  altitude 
errors  along  the  nominal  Impact  velocity,  viz: 
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'V 

31 

as 

a 

0 

1 

vc 
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where 


31 

15 


Vnt  Vr 


Is  the  mapping  of  state  errors  Into  Impact 
coordinates  (downrange,  crossrange,  and  time) 

are  the  nominal  velocity  components  along  downrange, 
crossrange  and  altitude 

Is  the  orthogonal  3 x 3 rotation  of  navigation  coor- 
dinates Into  downrange,  crossrange  and  altitude. 


The  CEP  can  be  approximately  calculated  as 
CEP  - 0.59 

where 


(vv  * vv) 


1 1 ^ j Is  the  element  of  Aj  In  the  1th  row  of  the  jth 
column. 


APPENDIX  Q . 

CALIBRATION  AND  ALIGNMENT  PERFORMANCE 
; EVALUATION  TECHNIQUES 

i . 

i ; B-l.  INTRODUCTION 

■ I 

[ ; The  analytic  technique  that  estimates  the  accuracy  of  calibration 

and  alignment  Is  described  In  this  appendix.  Basically,  the  lower  bound  ac- 
curacy of  a calibration  scheme  Is  estimated  with  optimal  Kalman  filtering 
i techniques.  The  deviation  of  the  actual  performance  of  the  calibration 

I technique  from  the  optimal  Kalman  performance  Is  assumed  small.  This  as- 

sumption is  made  because  If  the  optimal  technique  Is  substantially  more 
accurate.  It  Is  assumed  that  It,  or  a sufficiently  accurate  suboptlmal 
j mechanization,  would  be  Implemented.  With  this  simplification,  the  analy- 

I sis  of  many  calibration  techniques  can  be  case  In  a similar  form  and 

i quickly  performed. 

To  utilize  the  Kalman  filtering  techniques  In  the  analysis  of  a 
calibration  scheme,  the  physical  process  must  be  described  with  a linear 
state  space  model.  Thus  the  dynamics  of  the  errors  must  be  described  by  a 
linear  differential  equation,  and  the  measurements  taken  during  the  cali- 
bration sequence  must  be  linearly  related  to  the  errors.  These  two  require- 
ments can  be  written  In  the  form: 

■ i 

x ■ Fx  + Gw  (B-I), 

l • Hx  + v (B-2) 

j where 

I x Is  the  state  vector  describing  the  hardware  errors 

[ F,G,H  are  model  description  matrices 

; v,  w are  random  (white  noise)  disturbances. 

The  model  description  matrices  (F,  G,  and  H)  are  generally  complicated 
functions  of  the  orientation  of  the  Instrument  being  calibrated  and  the 
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time  derivation  of  the  measurement.  However,  these  matrices  can  be  com- 
puted numerically  with  little  difficulty. 

Equations  B-l  and  B-2  describe  the  system  dynamics  but  do  not 
directly  determine  the  calibration  error.  However,  Kalman  filtering  can 
make  use  of  the  same  model  description  matrices  to  perform  a covariance 
analysis  of  the  calibration  sequence. 

Kalman  filtering  descriptions  are  found  In  many  books  (see  for 
example,  Gelb  or  Medltch)  and  It  will  not  be  discussed  here  In  any  more 
detail  than  to  write  down  the  discrete  covariance  equations;  viz: 


Time  propagation: 

Pk(-)  ■ *Pk“l(+)4>T  + Q 

(B-3) 

Measurement: 

Pk(  + ) ■ (I  - KH ) Pk ( - ) 

(B-4) 

where 


K Is  the  Kalman  gain 

K - Pk(-)HT(HPk(-)HT  + R)"1 

0 Is  the  state  transition  matrix  from  the  k-lth  measurement 
to  the  kth 

Lj  k L 

P (-)  Is  the  state  covariance  prior  to  the  k measurement 
Pk(+)  Is  the  state  covariance  after  the  kth  measurement 

H Is  the  observation  sensitivity  matrix 
R Is  the  observation  noise  covariance 
Q Is  the  system  process  noise  matrix 

Equations  B-3  and  B-4  calculate  the  covariance  of  the  best  estimate  of 
the  state  errors  after  each  measurement. 

The  analysis  of  a calibration  sequence  is  threefold.  First,  the 
errors  of  the  hardware  (gyro  drifts,  accelerometer  biases,  structure1 
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compliances,  gimbal  readout  errors,  etc.)  must  be  Identified  and  error 
models  defined  (see  Appendix  A).  This  describes  the  hardware  mathemati- 
cally. In  addition  to  Identifying  the  hardware  errors,  the  Initial  un- 
certainties In  the  model  coefficients  must  also  be  estimated.  These  can 
come  from  hardware  tolerance  specifications,  previous  calibrations  or 
engineering  estimates.  Finally,  the  observation  sensitivity  matrix,  H, 
the  state  transition  matrix,  a,  and  the  system  process  noise  matrix,  Q, 
can  be  calculated  for  the  error  models  defined  and  the  calibration 
sequence  desired.  The  state  covariance  matrix  can  then  be  calculated 
for  the  measurement  sequence  of  the  calibration  and  alignment  technique 
under  Investigation. 

For  example,  consider  the  calibration  of  one  accelerometer  whose 
errors  are  a*>  exponentially  correlated  bias  noise,  a bias  and  a scale 
factor  error.  The  error  equation  for  the  accelerometer  would  be: 


ia  ■ n + b + sa 


where 


5a  Is  the  acceleration  error 

n Is  a time  correlated  bias 

b Is  the  bias 

s Is  the  scale  factor  error 

a Is  the  sensitive  axis  acceleration 


Assume  also  that  the  Initial  noise,  bias  and  scale  factor  uncertainties 
are  Jn,  and  j^,  respectively,  the  available  measurement  is  velocity, 
and  the  calibration  sequence  Is  the  usual  up-down  accelerometer  calibra 
tlon.  For  the  above  system  the  state  variables  are: 


■n  m 

V 

«■  I 

.bJ 

The  Initial  covariance  Is  therefore 
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P°(-) 


0 

0 o 
0 

0 0 


0 

2 
n 

0 a 


The  state  transition  matrix  can  be 
tlal  equation}  viz: 


X ■ FX 


where 


1 

•1/t 

Q 

0 


which  yields 


*(t,a)  ■ eFt 


1 

0 

0 

0 

• 

1 

0 

0 

0 


The  observation  sensitivity  matrix 

H - (1,  0,  0,  0) 

The  measurement  noise  Is 


0 

0 


calculated  from  the  system  dlfferen 


a 

0 

0 

0 


r(l-e"t/T) 

e-t/T 

0 

0 


t at 
0 0 
1 0 
0 1 


Is 


where  oy  Is  the  quantization  error  of  the  accelerometer.  Finally,  the 
process  noise  Is 
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Q(t) 

fl  $(t')q$T 

(t')dt' 

J 

0 

where 

*0 

0 

0 

■ 

0 

1 ■ 

0 

%2 

0 

0 

0 

0 

0 

0 

_0 

0 

0 

0 

which  yields 

‘<11 

*12 

3 

o" 

Q(t) 

■ 

^12 

q22 

3 

0 

0 

0 

3 

0 

0 

0 

3 

0 _ 

L 

where 

in  ■ "5' 

‘[* 

- 2t(  1 

- e 

•t/x 

+ 

i (1 

«« • - •'t/'  - i » - .-2t/')] 

q22  ’ "nl11  ’ Q'Zth) 

The  measurement  sequence  can  be  analyzed  as  follows.  First,  measure  the 
velocity  Integrated  by  the  accelerometer  after  T seconds  In  the  up  posi- 
tion. The  Initial  covariance  must  then  be  propagated  T seconds  as: 

Pl(-)  • *(T,  g)  P(-)/(T,  g)  + Q(T) 

The  measurement  yields  an  updated  state  covariance;  viz: 

Pl(  + ) ■ [ I - P1(-)HT(HP1(-)HT  + R)_1H  jp1  ( - ) 
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The  second  measurement  may  be  performed  in  a similar  fashion;  viz: 

P2(-)  ■ #CT.  -g)  p (-)/(T,  -g)  * Q(T) 

p2(  + ) • [i  - P2(-)HT(HP2(-)HT  + R)“1h]p2{-) 

and  the  resulting  covariance  P2<+)  yields  the  statistical  Information 
of  the  calibration  procedure. 


B-2.  SHIP  ALIGNMENT 


The  analysis  of  the  alignment  of  the  SHIP  followed  the  general 
procedures  outlined  in  Section  B-l.  The  hardware  was  modeled  with  the 
87  errors  described  In  the  SHIP  inflight  error  analysis.  The  result- 
ing model  description  matrices  were: 


> no  time  dependence 

G ■ 0 J 

R • measurement  noise  matrix 


where 


H 


for  Singer  Two-Step 


for  gyro  compassing 


are  the  sensitivities  of  velocity  sensed  by  the  SHIP 
to  the  error  models  defined  for  SHIP. 


are  the  sensitivities  of  the  drift  of  the  gyrocompass 
gyro  to  the  error  models  defined  for  SHIP. 


In  addition,  the  process  noise  between  measurements  consisted 
of  the  effect  that  the  glmbal  resolver  uncertainty  had  on  alignment 
about  up. 
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k- 
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The  SHIP  was  simulated  in  each  of  the  required  alignment  posi- 
tions to  calculate  H using  linear  error  analysis  methods  (see  Appendix  A) 
and  the  necessary  Kalman  processing  performed  (Equations  B-3  and  B-4). 

The  Initial  covariance  for  the  SHIP  alignment  analysis  was  the 
mature  post  calibration  error  budget. 

B-3.  DUAL  P5  CALIBRATION 

The  analysis  of  the  calibration  of  the  Litton  Dual  P5  Inertial 
reference  system  was  abbreviated  by  considering  the  calibration  of  only 
one  of  the  two  platforms.  The  calibration  of  the  other  platform  was 
assumed  Identical.  Thus  the  gyro  and  gimbal  errors  were  modeled  with 
46  error  sources.  The  model  description  matrices  were: 

F " 0 > no  time  dependence 

G • 0 ) 

R « gimbal  resolver  rate  error  covariance 

H - 

2 x 46 

are  the  sensitivities  of  the  Inner  and  outer 
gimbal  resolver  rate  readouts  to  the  error 
models  defined  for  the  P5. 

and  the  gimbal  resolver  rate  errors  were  those  given  by  Litton  for  the 
P5  platform,  The  measurement  sequence  was  then  simulated  and  the  estl 
mates  of  the  calibration  accuracy  determined. 


where 
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APPENDIX  C 

SYSTEM  PERFORMANCE  EVALUATION 


C-l.  INTRODUCTION 

i 

In  modeling  the  accuracy  of  a maneuvering  reentry  system,  the 
mission  was  divided  Into  four  phases: 

• Prelaunch 

• Boost 

• Freefllght 

• Reentry 

The  last  three  phases  of  flight  are  Illustrated  schematically  In  Figure 
C-l.  The  objective  Is  to  guide  the  reentry  vehicle  to  a preselected 
target.  During  each  phase  a particular  function  Is  performed  to  achieve 
the  final  objective.  In  the  prelaunch  phase,  the  coarse  reentry  IMU 
alignment  Is  determined.  During  boost,  the  booster  guidance  system  de- 
ploys the  reentry  vehicle  on  the  trajectory  to  Its  reentry  point  (300,000 
ft).  In  addition,  the  reentry  guidance  system  Is  calibrated  Inflight, 
(particularly  position,  velocity  and  platform  alignment).  In  the  free- 
fllght phase  the  Initial  reentry  state  Is  estimated.  During  reentry, 
the  reentry  guidance  system  navigates  from  the  Initial  reentry  state  to 
the  target.  The  error  analysis  program  handles  each  mission  phase 
separately. 

C-2.  ERROR  PROPAGATION 


To  calculate  system  accuracy,  a linear  system  error  analysis 
was  performed.  Since  standard  linear  error  analysis  was  not  sufficient 
for  our  purpose,  estimation  theory  was  used.  The  standard  analysis  as- 
sumes an  error  relationship  of  the  form 
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where 


Je 

A£  * AE^ 


(c-i) 


Ac  Is  the  error  In  the  state  vector  (RIMU  position, 
velocity) 

AE,  Is  the  Initial  error  source  vector  (RIMU  platform 
alignment,  accelerometer  and  gyro  errors,  etc.) 


— Is  a matrix  determined  by  Integration  of  error 
“ equations  on  a nominal  trajectory 


The  covariance  of  the  error  Is  given  by 


cov(4i)  . (If)  cov  (AE)  (If) 


where  superscript  T Indicates  matrix  transpose.  To  obtain  -—a  simulation 

3 E_ 

of  the  system  Is  needed.  Each  error  source  Is  perturbed  by  AEj,  and  the 
effects  are  Integrated  over  the  entire  trajectory  to  obtain  the  sensitivity 
3e 

. Unfortunately,  this  standard  linear  error  analysis  does  not  easily 

3E1 

accommodate  external  measurements.  Since  It  Is  desired  to  use  external 
measurements,  such  as  a match  with  the  booster  IMU  ( B I MU ) or  GPS 
measurements,  the  technique  of  linear  estimation  theory  was  used.  However, 
the  standard  linear  error  analysis  method  was  used  to  obtain  the  matrix 
3c 

~ for  Incorporation  Into  the  analysis  by  estimation  theory. 

With  linear  estimation  theory,  the  system  Is  described  by  a 
state  vector  X.  which  Includes  all  Information  relevant  to  the  state 
of  the  system,  such  as  position,  velocity,  and  error  sources  wnlcii 
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affect  the  system.  Typical  error  sources  for  the  case  of  the  B I MU  navaid 
are  shown  in  Table  C-l.  If  GPS  is  thenavaid,  then  reentry  vehicle 
clock  errors  and  GPS  satellite  errors  are  also  Included. 

The  system  model  assumes  that  calibrated  values  of  the  system 
parameters  are  compensated  inflight.  Therefore,  to  analyze  optimal  sys- 
tem performance,  the  state  vector  is  linearized  about  the  calibrated, 
values  of  the  system  parameters.  The  relevant  equation  Is 

X*(t)  - xf(t)  - dX^t) 

where 

A i>U 

X"{t)  is  the  actual  value  of  the  1 system  parameter  at 
time  t 

r f k 

X^(t)  Is  the  value  of  the  1 system  parameter  at  time  t 
as  stored  in  the  flight  computer 

5Xj(t)  Is  the  1th  system  error  at  time  t 

For  linear  error  analysis  5X(t)  Is  used  as  the  state  vector.  The 
composition  of  the  state  vector  for  the  case  of  a BIMU  navaid  is  shown 
in  Table  C-2.  Note  that  the  BIMU  and  the  G&G  errors  are  considered 
separately  from  the  RIMU  errors.  This  allows  separate  treatment  of  each 
portion  of  the  state  vector. 

The  linearized  state  vector  is  assumed  to  satisfy  the  linear 
differential  equation 


5X( t)  - F(t)6X(t)  + r(t)u(t) 


(C-2) 


Table  C-l.  System  Error  Sources 
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Reentry  IHU  (RIMU) 

• Alignment 

• Platform  (compliance,  gimbals) 

• Accelerometers 

• Gyros 

Booster  IMU  (BIMU) 

• Alignment 

• Platform  (compliance,  gimbals) 

• Accelerometers 

• Gyros 

Geodetic  and  Geophysical 

• Launch  and  target  location 

• Earth  model  (gravity  and  shape) 
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Table  C-2.  System  State  Vector 
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ECI  position  error 
EC  I velocity  error 


RIMU  alignment  errors 


RIMU  platform  errors 


RIMU  accelerometer  errors 


RIMU  gyro  errors 


BIMU  alignment  errors 


BIMU  platform  errors 


BIMU  accelerometer  errors 


BIMU  gyro  errors 


GAG  errors 


kiiiafth* 


.jA 


where 


SX(t)  ■ state  vector  at  time  t 
F(t)  ■ process  matrix 
j^(t)  ■ random  disturbance  vector 
r(t)  • disturbance  matrix 

The  covariance  of  ^(t)  Is  given  by 

E^(t)tt(t')Tj-  Q(t)fi(t-f) 

where  E symbolizes  the  expectation  operator.  The  Dirac  delta  function 
i(t-t')  Is  nonzero  only  If  t ■ t'.  The  covariance  matrix  has  a delta 
function  dependence  since  ui(t)  at  time  t Is  uncorrelated  with  uj( t 1 ) at 
a different  time  t' . 

Integrating  Equation  C-2  It  Is  found  that  the  state  vector 
propagates  In  time  by  a linear  transformation  with  a superimposed  random 
disturbance: 


6^1  " ♦l-l^l-l  + G1-l  -1-1 

where 

" linearized  state  vector  at  time  1-1 

■ state  transition  matrix 

■ random  disturbance  vector 

■ disturbance  transition  matrix 

The  covariance  of  ^ Is  given  by 

E(H,  SjT)  ■ <MU 


where 


\ 1 If  1 ■ J 
*1J  " | 0 If  1 M 


(C-3) 
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The  Kronecker  delta  s.j  is  used  for  the  discrete  time  case  and  Indicates 
that  at  time  i is  uncorrelated  with  Wj  at  a different  time  j. 

The  state  transition  matrix  can  be  shown  to  satisfy  the  differ- 
ential equation 

i(t)  • F(t)*(t)  (C-4) 

where  F Is  the  process  matrix  of  Equation  C-2.  The  Initial  condition 
on  $ Is 

*(tQ)  ■ 1 

where  I Is  the  Identity  matrix,  The  solution  of  Equation  (C-4)  for 
constant  F Is 

♦ (t.  tQ)  ■ e “ V 

where  $(t,  tQ)  Is  the  state  transition  matrix  from  time  tQ  to  t. 

The  discrete  noise  covariance  can  be  expressed  In  terms  of  the 
continuous  case  as 

T /*  k T T 

GK-1QK-1GK-1  7 t )G( t )Q( t )6  ( r )a  ( t^ , v)dT  (C-5) 

Vl 

Measurements  are  taken  at  discrete  time  points,  and  they  are 
assumed  to  be  linearly  related  to  the  state  vector  by 

4Zj  ■ HjiXj  + v1  (C-6) 

where 

■ linearized  measurement  at  time  1 
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H|  • measurement  matrix 

■ random  measurement  noise 

The  covariance  of  ^ Is  given  by 
E(^j)  " Vlj 

The  linearized  measurement  Is  related  to  the  actual  measurement  by 


where 

a 

Z/|  • actual  measurement 

r 

Z|  - nominal  measurement  expected  If  state  vector 
equaled  XG 

Using  the  discrete  time  formulation,  the  state  at  time  1 Is 
estimated  from  an  earlier  estimate  at  time  1 - 1 by 

^ * ^i»j  ^-“1«1  (C"7) 

where  the  symbol  X Indicates  the  estimate  of  X.  The  covariance  P Is 
propagated  In  time  by 

P1  " *1-iPM  ^i-lT  + GMQMGMT  (C‘8) 

The  state  Is  updated  after  a measurement  with  the  standard  Kalman  filter; 

«Xi+  • 4.;  + ^ - Hi  aXt”]  (C-9) 


LOGICON 


The  corresponding  covariance  update  is 

P/  * (I  - Kj  H^Pj"  (C-10) 

where  ■ P^*H^(H^"H^T  + Rj)"1  Is  the  Kalman  gain  and  the  super- 
scripts + and  • Indicate  before  and  after  a measurement. 


The  error  propagation  equations  require  the  calculation  of  the 
state  transition  matrix  a.  From  Equation  C-2  It  Is  seen  that  knowledge 
of  the  system  dynamics  determines  the  process  matrix  F.  The  process 
matrix  In  turn  gives  rise  to  the  state  transition  matrix  (Equation  C-4). 
Therefore,  the  first  step  In  calculating  the  transition  matrix  Is  to 
determine  the  process  matrix  from  the  system  dynamics. 

The  differential  equation  of  motion  solved  by  navigation  Is 


where 


P 


A-S 


P 


P ■ position  vector 
V ■ velocity  vector 
As  ■ sensed  acceleration  vector 
GM  ■ earth's  gravity  constant 


However, 

+ ^ 

V • VA  + iV 
P • PA  + ap 

where  superscript  A signifies  the  actual  value  (assuming  no  errors) 
and  .1  represents  an  error  term  about  the  actual  value. 
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I r~: 


Therefore, 


VA  ♦ av  ■ Aj  + fiAs  - ^ SP 


(aP  . pA)pA  - -SSiL  pA 


Substractlng  out  the  actual  terms, 


av  - a - -SU  iP  ♦ -3SM-  (ap  • pa)pa  - pa 

“•  -"j  * . 1 ■“  » * . 3 mm  “ * "*  i i i J 


The  term  6^  Is  due  to  alignment,  platform  and  accelerometer  errors: 
aAg  ■ 4i  * Ag  + aAp  ♦ 


where 

a*.  ■ platform  alignment  errors 

aA„  ■ sensed  acceleration  errors  due  to  platform  errors 

~r 

aA«  ■ sensed  acceleration  errors  due  to  accelerometer 
hA 

errors 

The  aAp  term  Is  modeled  as  a function  of  the  sensed  acceleration  and  the 
platform  errors: 

^Vx  “ fX  ^S* 


<*AP>V  • fy  (Ag,  g*) 
(iAp)z  • fz  (Ag,  EpR) 
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Similarly,  can  be  written  as 

<saa>x  ■ 9X  <*s.  Ea") 

<sAA>  • 9,  tis.jA 
Y ✓ 

liAA>z  ’ 9Z  (is.  IaR) 

The  sensed  acceleration  errors  can  therefore  be  expressed  as 
SAS  ■ 4*  x Ag  + f £pR  + g g* 


where  f and  g are  matrices  given  by 
3Ac 

f • jr 


Writing  the  previous  equation  of  motion  In  terms  of  the  Indi- 
vidual components,  the  errors  In  RIMU  position  and  velocity  propagate 
in  time  by 

3PX  - 5VX 


6Py  ■ 6Vy 
<$F>Z  • 3VZ 


(C-il) 


iVx  • (a  + 6PXZ)6PX  + 3PxPy5Py  + ^PxPZ‘5PZ 

+ AszS$y  - AsyS«z  + E fxj ^EpR^ j + j fyj  ^EA^j 
+ YPxi(GM) 


LOGICON 


where 


SVy  » BPyPX-SPX  + (a  + BPy2)5Py  + tjPyP^ 

+ Asxd^2  - AS26^x  + S f YJ  ^EpR)j  * J 9Yj(EAR)j 
+ YPyi(GM) 

6h  " bPzpx6Px  + sPzpy3Py  * + sp22)<$p2 

+ A$y^x  - A$xi*y  + S fzj t£pR) j + j 9zj  <EAR)j 
♦ YPZ5(GM) 


GM 


To  keep  the  equations  relatively  simple,  a spherical  earth  was  assumed 
for  Equation  C-ll.  However,  In  the  actual  simulation,  higher  order 
spherical  harmonic  gravity  terms  were  Included  In  addition  to  the  GM 
term  given  In  Equation  C-ll,  The  alignment  In  the  above  equations  is 
expressed  In  the  same  coordinate  system  as  the  position  and  velocity 
errors.  By  means  of  an  orthogonal  coordinate  transformation,  the 
alignment  errors  can  be  easily  expressed  In  platform  coordinates  even 
If  It  differs  from  the  position  and  velocity  coordinates. 
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The  RIMU  platform  al Ignment  errors  are  modeled  as  functions  of 
the  sensed  acceleration  and  the  gyro  errors: 

■ hx  JgR> 

Sty  ■ hy  (Aj,  gGR)  (C-l 

1 

" hz  ^ kR)  \ 

The  RIMU  platform,  accelerometer,  and  gyro  errors  are  modeled  as  constants 

4r  • 0 

h*  ■ ° \ 


Changes  In  these  quantities  are  handled  by  Including  process  noise 
(Q  matrix).  Since  the  BIMU  errors  are  modeled  as  error  sources  (l.e. 
Initial  values),  these  errors  are  also  constant  In  time: 

4lMU  " 0 

Finally,  the  G&G  errors  are  modeled  as  constants: 

km  ■ 0 

The  F matrix  can  be  determined  from  the  relation 
X « FX 
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Decomposing  the  state  vector  into  its  components 


— — 

— — » 

— — 

i 

F11  F12  0 F14 

s 

^RIMU 

o 

o 

CM 

CM 

Ll_ 

o 

^RIML) 

■ 

» 

^BIMU 

0 0 0 0 

4imu 

• 

Jg&g_ 

0 0 0 0 

Jg&g_ 

and  Fjj  are  obtained  from  Equation  C-ll  and  are  given  in  Figures 
C-2  and  C-3.  Fg2  ol3ta''ni8d  from  Equation  C-12  and  is  given  in  Figure 
C-4.  Because  G&G  errors  cancel  In  a^BIMU/RIMU  measurement,  the  F14  term 
was  not  Included  in  the  calculation.  Position  and  velocity  errors  due  to 
to  G&G  were  added  In  near  the  end  of  the  calculation  (after  all  measure- 
ment updates)  to  obtain  system  performance.  Note  that  for  the  GPS  case, 
G&G  errors  can  be  estimated  from  pseudo-range  measurements.  An  F^  term 
was  therefore  Included  for  the  GPS  analysis. 

To  propagate  the  covariance  in  time,  the  standard  discrete  form 

is  used: 

PK+1  ' ♦kVk'  + GKQKGK 
where  Is  a solution  of 

r\ 

4>(t,  t^)  ■ F(tMt,  tK)  ; *(tK,  tK)  ■ I 

For  a constant  F,  the  solution  of  the  transition  matrix  equation  is 


$ « e 


FAt 
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Figure  C-2.  System  Process  Matrix  F 
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represents  the  RIMU  platform  error 


represents  the  RIMU  accelerometer  error 


Figure  C-3.  System  Process  Matrix 
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Figure  C»4.  System  Process  Matrix  F?« 
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For  variable  F,  a small  time  interval  can  be  chosen  during  which  F is 
approximately  constant.  $ Is  then  approximated  over  the  Interval  ,\t  as 
the  product 


n F.at/n 

♦ • n e 


where  is  the  average  F over  the  appropriate  subinterval.  The 
exponential  can  be  further  approximated  as 

F^t/n  JL  (F, 
e ■ L,  - 1 


Thus, 


J-0 


Jl 


n 

•>  * n 


E 


a (f1  ^)'j1 


ji 


IC-14) 


The  quantities  n and  m are  chosen  to  be  sufficiently  large  so  that  the 
approximations  are  adequate. 


C-3.  INFLIGHT  ALIGNMENT 

The  Kalman  filter  (Equation  C-10)  Is  used  to  evaluate  the  per- 
formance of  the  alignment  update.  In  this  appendix,  the  case  of  a 
measurement  using  the  BIMU  is  described.  To  take  a specific  example, 
a velocity  measurement  is  considered.  A similar  procedure  Is  used 
for  a position  measurement.  The  velocity  measurement  is  defined  by 


£ ’ -RIMU  " -BIMU 


C-19 


LOGICON 


The  Individual  velocity  terms  can  be  expressed  as 

^filMU  ’ ^ACTUAL  + 5%MU  + 5^UANT  4 6^G&6 

^3IMU  “ ^ACTUAL  + 6^eiMU  4 44uANT  4 a^G&G 

where  the  velocity  errors  due  to  G&G  and  due  to  quantization  are 
separated  from  the  other  velocity  errors.  The  measurement  equation  Is 
thus: 


2.  " S^IMU  ■ fi^BIMU  4 4¥qUANT  ' 44uant  (C“15) 


Since  all  BIMU  errors  are  treated  as  constant  error  sources  (l.e.  as 
Initial  values),  the  BIMU  velocity  error  as  a function  of  time  Is  given 
by 

aV 

sSflIMU  ‘‘I  * 5E^  (l>  ^IHU  (C-16> 

where  the  derivative  Indicates  the  sensitivity  of  BIMU  velocity  error 
to  Initial  sources.  Substituting  Equation  C-16  Into  Equation  C-15,  we 
arrive  at 


i ■ 5s«imu 

- <5V® 
^UANT 


(t)  - 


3V 

^eiMU 


^BIMU  + 4%ANT 


(C-17) 


% 

where  t Is  the  time  of  the  measurement  (thrust  termination  for  this 
study).  From  Equation  C-17  t'he  measurement  matrix  Is  seen  to  be 


H 


“0  0 0 1 0 0 

0 0 0 0 1 0 

.0  0 0 0 0 1 


! 3V(t) 

S - TP 

I 3%IMU 

I 


0 


and  the  noise  y Is  given  by 

R B 

1 " ^QUANT  ‘ fi¥qUANT 
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The  covariance  R is 


R 


“q  0 O' 
0 q 0 
.0  0 q. 


where 

q « cov  (4VqUANT  - «VqUANT) 


Substituting  the  measurement  and  noise  covariance  matrices  Into  the 
Kalman  filter  (Equation  c-10),  the  state  Is  updated,  yielding  an  Improved 
estimate  of  RIMU  platform  alignment,  position,  and  velocity. 


C-4.  REENTRY  INITIALIZATION 

After  the  last  measurement  has  been  made,  Equation  C-8  Is  used 
to  propagate  the  covariance  matrix  to  reentry.  So  far,  position  and 
velocity  errors  due  to  Q&G  have  not  been  Included  for  the  case  of  the 
booster  navald.  (F^  of  Equation  C-13  was  not  Included  In  the 
calculation  for  the  BIMU  navald  case.)  Therefore,  at  this  point  position 
and  velocity  errors  due  to  G&G  are  combined  with  errors  due  to  other 
sources  to  obtain  the  total  position  and  velocity  error.  The  covariance 
matrix  at  this  point  represents  the  full  covariance  of  the  state  at 
reentry  for  the  case  of  an  optimal  state  propagation  method  such  as  a 
simulation.  If  other  propagation  methods  are  of  Interest,  additional 
errors  due  to  the  particular  technique  must  be  included. 
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C-5.  INCORRECT  SYSTEM  MODELING 


The  discussion  so  far  has  centered  on  calculating  the  covariance 
for  the  optimal  case  In  which  the  complete  system  dynamics  and  measurements 
are  modeled  correctly.  Due  to  computer  restrictions  or  lack  of  knowledge 
of  the  system  dynamics,  it  Is  not  always  possible  to  simulate  the  system 
exactly.  In  this  situation  It  is  still  necessary  to  be  able  to  evaluate 
system  performance,  although  the  standard  equations  for  optimal  estimation 
no  longer  hold.  The  appropriate  equations  are  given  here  without  proof. 

A derivation  can  be  found  In  Section  C-7. 


The  true  system  dynamics  are  given  by 

-J  “ *J-1  -J-l  + Gj-1  Vi 
The  true  measurement  Is  related  to  the  state  by 


(C-18) 


-J  “ HJ  -J  * 


(C-19) 


The  covariance  of  Wj  and  ^ are  qj  and  Rj  respectively.  The  suboptlmal 
filter  assumes  the  model  to  be 


★ 

k 


(C-20) 


Zj  • Hj*  Xj  * IC-21) 

* * * * 
where  the  covariance  of  Vjj  and  are  respectively  Qj  and  Rj.  The 

starred  quantities  do  not  necessarily  equal  the  unstarred  quantities 

modeled  In  Equations  C-18  and  C-19,  The  equations  used  by  the  filter  to 

update  the  state  and  covariance  are 


♦ 0* 

♦j-i  2j-i 

**.  * / * •*.  \ 
-j  + Kj  ‘ Hj  -J-i  / 


(C-22) 
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p3  ■ *1-1  "3-1  *3-i  * a3-i  q3-i  53-i 
p3+  ■ (■  - *3  *3)  p3' 

vpj  y(Vj  hj  *pj) 

Since  the  filter  does  not  model  the  system  correctly.  It  produces  a 
suboptlmal  estimate  of  the  state.  In  addition,  the  quantity  P calculated 
by  the  filter  does  not  represent  the  true  covariance  of  the  state.  The 
true  covariance  Is  propagated  In  time  by  the  following  set  of  equations: 


PK  - ♦k-I  PK-1  *K-1  + *K-1  VK*1  VK-1 


(C-23) 


+ A4K-l  UK-1  ^K-l  + GK-1  QK-1  SK-1 

T T 

VK  B *K-1  VK-1  *K-l  + *K-1  UK-1  A*K-1  ‘ GK-1  QK-1  GK-1 

UK  * ♦K-l  UK-l  ♦I-l  * GK-i  QK-i  GK-1 

After  a measurement  the  true  covariance  Is  given  by 

PK  - (I  - kk  hk)  pk  (I  - kk  hk)'  - (I  - kk  hk)  vk*  AH^  kk 

- Kj  aHk  V“  (I  - K*  h|J)T  + K*  AH„  UJ  AHj  kJT  + kJ  R„  K*T 


K K K "K 


V*k.V-(I-k;  H*k)T  - U-  4Hj  $ 

^‘"ii 


K K K 

(C-241 


C-23 


l 
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where 


* 

Ai(i  ■ ^ * $ 

aH  ■ H*  - H 

p - e [a  - i*)  a-  xV]-  cov  oj 

U - E [&T] 

v - -e  [ia-  iV] 

In  the  above  equations.  E Indicates  the  expectation  operator.  Using  the 
above  equations,  the  true  covariance  of  the  state  can  be  propagated. 

This  technique  was  used  to  estimate  the  accuracy  of  the  state  at  reentry 
for  the  case  In  which  a subopt  1 ma 1 filter  was  used  to  process  GPS  mea- 
surements. 


C-6.  COMPUTER  PROGRAM  ORGANIZATION 

A flow  diagram  indicating  the  computer  programs  used  In  the 
system  performance  evaluation  Is  shown  In  Figure  C-5.  The  linear  error 
analysis  program  (Appendix  A)  generates  the  RIMU  transition  matrices  (F^, 
f12*  f 14 * ancl  F22^  the  boost  and  reentry  portions  of  the  trajectory. 

For  the  GPS  case.  It  also  generates  transition  matrices  of  the  navaid  (sat- 
ellite) position  and  velocity  error  due  to  G&G.  GEM  represents  several 
programs  which  generate  a magnetic  tape  consisting  of  the  riavald  transition 
and  measurement  matrices  and  the  RIMU  measurement  matrix.  For  the  case  of 
the  BIMU  navaid,  the  navaid  transition  matrix  and  the  RIMU  measurement 
matrix  are  the  Identity  matrix.  The  system  error  analysis  program  (SEAP) 
uses  the  Kalman  filter  formulation  to  evaluate  performance.  The  RIMU  free- 
fllght  transition  matrices  are  generated  Internally  by  SEAP.  Effects  due 
to  disturbance  noise  (Q  matrix)  for  both  the  RIMU  and  the  navaid  are  cal- 
culated by  SEAP.  Covariance  matrices  at  the  points  of  Interest  are  output 
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by  SEAP  In  several  coordinate  systems:  ECI,  downrange  - crossrange  - 

altitude,  or  downrange  - crossrange  - time.  These  covariance  matrices 
describe  the  system  performance. 

C-7.  SUSOPTIMAL  FILTER  EQUATIONS 

This  section  presents  equations  which  calculate  the  true  co- 
variance  of  a state  as  estimated  by  a suboptima 1 filter.  They  may  be  ap- 
plied to  the  linear  discrete  case  In  which  the  suboptlmal  filter  employs 
Incorrect  transition  and  measurement  matrices , suboptlmal  gains,  and  a 
reduced  order  state  vector.  Analogous  equations  can  be  found  In  Reference 
C-l  for  the  special  case  of  the  suboptlmal  filter  employing  the  full  size 
(truth  model)  state  vector. 

A linear  system  Is  assumed  for  the  system  model.  Thus,  state 
vector  dynamics  is  given  by; 

xk  ■ ♦k-i  xk-i + Gk-i  Vi  (c-?5) 

where 

■ state  vector  at  time  k-1 

■ state  transition  matrix 

wk-^  ■ zero  mean  random  disturbance  vector  at  time  k-1 
®k-l  * disturbance  transition  matrix 
A measurement  of  the  state  at  time  k Is  given  by: 

«k  ■ Hx  xk  + vk  (c-26) 

.■•here 

zk  ■ measurement  vector  at  time  k 

■ measurement  matrix 
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V|^  * zero  mean  random  measurement  noise  vector- 
at  time  k 

x Is  an  n vector;  w Is  an  p vector;  2 Is  an  m vector;  all  other 
quantities  are  assumed  to  be  dimensionally  compatible,  x Is  assumed  tc 
be  a zero  mean  variable.  In  addition,  the  covariance  of  w^  Is  given 
by  and  the  covariance  of  Is  given  by  R^: 

EH  "jT>  ' Gk  sJk 

E<vk  vjT>  - *k  sdk 
EK  Wj)  ■ 0 

Note  that  wk  and  at  time  k are  each  uncorrelated  with  Wj  and  v,  at  a 
different  time  j,  and  that  w^  and  are  uncorrelated  with  each  other. 

The  suboptlmal  filter  assumes  the  following  system  model: 

xk  ■ *k-i  xk-i  * Gk-i  vi  <c'27) 

■ Hk  + (c"2a) 

A it  if 

where  x Is  an  / vector,  w and  v are  described  statistically  by 

E("k  "j1  ' Qk  SJk 

EK  *J*>  ■ < 5Jk 
E(wk  Vj)  ■ 0 

The  filter  can  therefore  assume  Incorrect  system  dynamics.  In  addition, 

the  filter  does  not  necessarily  account  for  all  elements  of  the  state 

* 

vector  since  x can  have  a smaller  dimension  than  x. 

The  relation  between  x*  and  x is  given  by 
' x*  ■ Wx  (C-29) 
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f * 

where  W Is  an  l x n matrix.  If  x is  formed  by  deleting  bias  states 
from  x,  then  W takes  the  form 

W - ( I ! 0) 

In  this  case  the  state  vector  x is  partitioned  as. 

x ‘ (I-) 

and  the  filter  uses  only  the  states 
x*  - (s) 


Thus, 

x*  - (s)  • (I  I 0)  (f)  - Wx 

The  covariance  equations  can  be  derived  from  the  above  by  letting 
W*1  be  defined  by 

WW’1  - I (C-30) 

If  x*  Is  formed  by  deleting  bias  states  from  x,  then  W"1  has  the  form 

if 1 - (C-31) 

(Actually,  any  quantity  can  replace  the  0 In  the  above  equation  and  still 
satisfy  Equation  C-30.  However,  for  Equation  C-30  to  be  correct,  If1  Is 
uniquely  given  by  Equation  C-31  for  the  case  of  deleting  bias  states  from 
the  state  vector.)  Let  be  the  suboptlmal  filter's  estimate  of  x at 
time  k-1.  Tho  error  x^  In  the  filter's  estimate  of  the  state  vector  Is 
given  by 

*k  * W"lxk  * xk  (C-32a) 

The  filter  estimate  of  the  state  is  propagated  In  time  by 

xk  . *k.,  xk.,  (c-3?b) 
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Substituting  Equations  C- 25  and  C- 27  into  Equation  C-32a  and  doing  some 
algebraic  manipulation  we  get 

*k  " w \-l  xk-l  ‘ Vl  Vl  + Gk-l  wk-l* 

h “ W \-l  WW  1 Vl  * w \-l  Wxk-1 
+ W \-l  Wxk-1  “ Vl  xk-l  ' Gk-1  wk-l 

The  resulting  equation  Is 

*k  “ Vi  *k‘l  + *k“l  * Gk":  Vl 


where 


w 


k-1 


w-‘  ♦‘.jW 


A*k-l  ■ *»„.!  • *k-l 


(C-33) 


Let  us  define  a new  vector  X by  the  relation 

*■(1) 

X is  propagated  in  time  by 


■ G)  • 


*Vi 

Vl 


Vl 

Vi. 


»w 


i + Gi 


k-1 


k-l 

"k-1 


The  equation  for  the  mean  square  value  of  X is  given  by 


E (XXT) 


• E 


T T 

xx 1 xx 1 

„T  T 

ixSl  xx 


(C-34) 


(C-35) 
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Substituting  Equation  C-34  Into  Equation  C-35,  we  find  that  T""  propagates  in 
time  by 

/ * \ i * vT 


- P 

' k-1 


/wk-lwk-lT  “wk-lwk-lT\  T 

+ EM  T 

'"wk-lwk-l  wk-lwk-l  / 


Defining  the  quantities  P,  U,  V by 
P - E(XXT) 

U - E(xxT) 

V - E(xXT) 

the  quantity"/5  1$  seen  to  be  given  by 

-P.  (P  A 

\v  u / 


(C-36) 


(C-37) 


P Is  the  covariance  of  the  filter  estimate  of  x and  is  the  quantity  we 
are  trying  to  calculate.  U Is  the  mean  square  value  of  the  state  vector 
x,  with  no  estimate  of  the  state  substracted  off.  If  the  Initial 
covariance  of  x before  the  first  measurement  (l.e.,  before  the  estimate 
of  x Is  updated  from  zero)  Is  given  by  PQ,  then  the  Initial  conditions 


U0  “ P0 

vo  - -po 


(C-38) 
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Multiplying  out  the  matrices  in  Equation  C-36  and  comparing  with 
Equation  C-37,  we  find  that  the  covariance  Is  propagated  in  time  by 

Uk  ■ Vl  “k-l  *k-l  * Gk-1  Gk-1  <-1  IC'39> 

vk  * *k-l  vk-l  ^ + *k_1  Uk''  4^k"1  ' Gk_l  5k'1  Gk*1 

pk  ' \.i  "k-l  *?.,  + 4*K-1  Vl  *Zl 

* \-l  <k‘1  A*k_1  + 4*k_1  Uk-1  Mk-1 


Note  that  the  propagation  of  the  true  covariance  P does  not  explicitly 
depend  on  q . By  contrast,  the  covariance  as  calculated  by  the  filter 
(computed  covariance)  Is  given  by 


P 


* 

k 


* T 

Vi 


* 

The  computed  covariance  Is  therefore  a function  of  Q . 

SI  ml  1 • ■ equations  can  be  derived  for  a measurement  update.  The 
★ 

estimate  of  x after  a measurement  is  given  by 


**+  a*  - * f * ■'*  -1 

*k  ■ xk  + kk  Lv  Hk  xk  J 


where  Kk  Is  the  gain  used  by  the  filter.  The  error  In  the  estimate  is 
given  by 


+ - 1 -'W+ 

kk  • w xk  - xk 


x _i  **-  _i  # r * '*  -i 

\ ■ “ xk  * “ \ lv  \ xk  J - 
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(C-40) 


where 


\ ■ W 1 xR  - xk  - W xKk  Hk  WW  1 xk 
+ if1  Kk  Hk  Wxk  - W1  Hk  Wxk 

+ W 1 Kk  Hk  xk  + W 1 Kk  vk 

\ * K “ Kwk  Hwk  *k  “ \ \ + Kw|(  vk 


# * 

Hw  - Hk  W 
wk  * 

v • “ 1 \ 


“k  ■ \ - Hk 

Augmenting  the  state  vector  as  before 


and  taking  the  moan  square  value  of  Xk,  we  can  use  Equations  C-26,  C-28, 
C-37,  and  C-40  to  obtain 


u£  -u; 


(C-41) 


vk  ■ vk  - \ \>T  • uk  < <kT 

K ■ 0 “ <w  «w  ) P,  (I  - K,  H )T 
* wk  wk  x wk  wfe 

“ 0 “ K*  H > VkT  AHk  K T 

■Wk  Wk  K K Wk 

- K*  4Hk  vr  (I  - K*  H*  )T 

Wk  K K Xk  Wk 
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+ <k  ^k u;  V \T 

+ iC  \ *c T 

"k  K ^k 


Note  that  the  measurement  update  of  P does  not  explicitly  depend  upon  R . 
However,  Equation  C-41  does  Implicitly  Involve  R and  Q If  the  gain  K Is 
chosen  to  be  a function  of  these  quantities.  Note  that  If  x ■ x (l.e., 

W ■ I)  and  the  correct  dynamics  are  Implemented  (aH  ■ &+  ■ 0),  then 
Equations  C-39  and  C-41  reduce  to  the  standard  form  for  the  optimal  Kalman 
filter. 

If  the  filter  state  x*  Is  formed  by  deleting  states  from  the  full 
state  vector  x,  then  the  covariance  P can  be  expressed  In  terms  of  the  re- 
tained states  s and  the  deleted  states  b: 

> T)  ■■  |-l:)  - (•!•)§!-)  - (+)]'j 


(l  (2  - S ) ( x - s)  1 E -(2 

l * T T 

V E I -b(2  - s)  j E [bb 

Defining  P^,  P2,  P3  by 

' * * n 

Pj  ■ E (2  - s)(2  - s)  J 
P2  • E -b{2#-  s)T] 

P3  - F,[bbT] 


(2  - s)b 


P2  ■ E 


P3bF 


t * 


'vrr.'f  -.n  --  , 
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the  covariance  P Is  seen  to  be  given  by 


1 


\ 


9 


i:  f 


i 


Equations  e-39  and  C-41  provide  the  full  covariance  matrix  P and 
are  equivalent  to  propagating  a 2n  x 2n  matrix.  For  large  n this  can  re- 
quire excessive  computer  time  and  memory.  Often  one  Is  Interested  only  In 
the  quantity  P^.  In  this  case,  It  Is  possible  to  formulate  equations  which 
require  propagation  of  an  (n  + t)  x (n  + sl)  matrix  where  i is  the  order  of 

<k 

x . This  can  result  In  significant  savings  If  most  states  In  the  state 
vector  are  to  be  deleted. 

Define  the  following: 


\ 

-HSk 

< 

■ K - % 

A*k 

■ ♦!“  - “*k 

ah; 

■ v • Hk 

1 

P 

, . T 

• E(*  R 

l 

V 

, T 

■ E(x  * ) 

1 

u 

■ E(x  x T)  1 

C-34 


■Trrrrr  jv  x : : * * ■ 1 ■ 


LOGICON 

The  covariance  of  the  retained  states  can  be  derived  as  before.  Since 
the  method  has  already  been  presented,  only  the  results  are  given  here. 

The  Initial  condition,  before  an  estimate  of  the  state  Is  per- 
formed, Is  given  by 

1 1 T 

V.  - -U.  W1 
O 0 

1 ' T 

■ WUrt  wr 
o o 

The  covariance  is  propagated  In  time  by 


uk  " Vl  uk-l  *k-l  + Gk-1  Qk-1  Gk«l 
vk  “ *k-l  vk-l  ♦k-l  + Vl  uk-l  A*k-1  “ Gk-l  Qk-l  ®I. 


(C-42) 


k-l 


pk  “ *k-l  pk-l  *k-l  + A*k-i  vk-l  ♦k-l 
+ *k-l  vk-l  **k-l  + A*k-l  uk-l  ^k-1 


+ \ Qk-l  ^ 

K-l  K 1 wk-l 


The  measurement  update  Is  given  by 


i+  i- 

uk  • uk 


* * 


\ «.  * *k  Hk»T  - < -iT  <T 

\ * » ■ < V Pk'  0 ' < <>T 

. , .-T  ,T  *T 

- (!  - Kk  Hk)  \ 4Hk  Kk 

' < 4Hk  \ « ' < <)T 
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+ \ AHk  uk  *Hk  Kk 

* *T 

+ Kk  Rk  Kk 


In  summary,  the  following  equations  can  be  used  to  propagate  the 
full  suboptlmal  filter  covariance: 


Initialize  with 


Vpo 


vo  • -po 


(The  Initialization  assumes  no  prior  estimate  of  the  state.) 

Propagate  In  time  by 

uk  ' Vl  uk-l  *k-l  * S-l  Vl  Gk-J 

vk  * Vl  vk-l  V/  + Uk-1  4*k-l  ‘ Gk-1  Qk-1  Gk-1 

pk  ‘ \.j  pk-l  \.lT  * Mk-1  Vl 

* Vl  Mk-I  * 4Vl  uk-l  wk-l 

* Gk-1  Vl  Vl 

Update  after  a measurement  by 

uI"u'k 

< • \ <>\  %>  • uk  V \ 
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‘ <k  V“k  \>T 

♦ k!  % UI  % T *C  T 
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+ <!  \ k!  t 

Similar  equations  can  be  used  to  propagate  the  covariance  of 
the  states  retained  by  the  filter. 
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APPENDIX  D . 

LINEAR  REGULATOR  GUIDANCE 

In  this  appendix  the  results  of  the  analysis  of  the  application  of  Linear 
Regulator  theory  to  the  problem  of  steering  an  aerodynamlcally  controlled 
maneuvering  re-entry  vehicle  are  described. 

In  Section  D-l  a steering  law  and  a methodology  for  the  selection  of  the 
associated  weighting  matrices  are  derived  using  time  as  the  system 
variable  of  evolution. 

In  Section  D-2  the  use  of  a state  variable  as  the  variable  of  evolution 
Is  Investigated.  A steering  law  formulation  for  this  case  is  derived 
and  simulation  results  presented. 

In  Section  D-3  the  use  of  transformations  depending  on  the  Instantaneous 
vehicle  state  to  define  the  evolutionary  variable  are  considered  and  the 
mathematical  theory  of  Appendix  D-2  modified  to  Incorporate  this  case. 


D-l 


ih  tail 


0-1. 


CONTROLLERS  IN  THE  TIME  DOMAIN 


In  this  section  controllers  operating  In  the  time  domain  are  considered. 
A controller  based  on  the  Linear  Quadratic  Regulator  Is  derived  and  the 
stability  and  controllability  properties  are  examined.  The  analysis  of 
these  properties  leads  to  a methodology  based  on  these  properties  for 
the  selection  of  the  weighting  matrices  associated  with  the  regulator 
formulation. 


D-l.l  Time  Domain  System  Description 


For  the  present  studies  the  vehicle  Is  assumed  to  be  a bank-to-turn 
vehicle  which  orients  the  acceleration  vector  by  changing  the  vehicle 
bank  angle.  The  target  centered  coordinate  system  and  the  trajectory 
and  vehicle  orientation  angles  are  as  shown  In  Figure  D-l. 


i 
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Trajectory  Equations 


The  nonlinear 


dynamic  aquations  of  motion  for  the  vehicle  are: 


A 


i 


!'  i 

1 ;• 

f 1 


X ■ V COS  Y COS  f 

y « V cos  Y sin  f 

2 - V sin  Y 

i _ A coso  g cosy 

Y . ...  + a. 

J _ A slno 

r V COSY 

V - -jj  + g sin  y 

A ■ -a  A + a Ac 

• 

<p  a -b  + b <PC 
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where  A„  is  the  commanded  acceleration  and. A is  the  actual  acceleration, 
c 

and  where  t Is  the  actual  bank  angle  and  Is  the  commanded  blank  angle, 
a and  b are  the  autopilot  corner  frequencies. 

The  assumptions  in  (D-l)  are  constant  gravity  (g)  and  flat,  nonrotating 
earth.  The  drag  force  0 Is  a function  of  angle  of  attack,  Mach  number, 
and  altitude. 

0-1. 1.2  Approximate  Trajectory  Model 

In  previous  studies  it  has  been  found  that  the  velocity,  V,  behaves  In 
such  a manner  that  the  difference  between  it  and  the  nominal  velocity 
can  be  Ignored.  So  In  the  approximate  model  the  $ equation  will  not  be 
used,  and  whenever  V is  needed  In  the  other  equations,  It  will  be  replac- 
ed by  the  nominal  velocity,  VN«  This  approximation  follows  since  V Is  a 
slowly  varying  monotonically  decreasing  variable,  ana  the  PGRV  has  no 
direct  control  over  velocity  magnitude  (l.e.,  no  thrust  or  braking). 

Also  It  Is  assumed  that  the  gravity  force  is  negligible  In  comparison  to 
the  latoral  acceleration  force  for  the  PGRV  maneuvers.  These  approxima- 
tions reduce  Equations  (D-l)  to  the  following  equation  set: 


x ■ 


z ■ 

Y - 

Y ■ 
A ■ 

3 » 


cos  Y cos  Y 
VN  cos  Y sin  Y 

VN  sin  Y 
A cos  $ 


A 

VT 


sin  b 

COSY 


aA  + aA„ 
c 


-b  v + b v> 

c 


(D-2) 
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For  convenience,  let  us  denote  (D-2)  by 


£(t)  - f U(t),  u(t) ) ; tfl  a t s tf 


«‘o>  • 6° 


(0-3) 


where  5 Is  a vector  of  seven  components  given  In  (D-2)  and  u(t)  Is  the 
vector  actuating  signal  given  by 


u(t)*  ♦„<»> 


»ct‘> 


(0-4) 


The  vector  function  f can  be  Identified  from  (D-2). 

Corresponding  to  a nominal  value  for  u,  say  un,  there  Is  a solution  to 
(D-3)  which  gives  the  associated  nominal  trajectory.  Denote  by 
(xn,  ufl)  the  nominal  vehicle  trajectory  and  control,  with  xR(t); 
tQ  a t a ^ the  solution  to  (0-3)  corresponding  to  the  open-loop  control 
un<t);  tQ  s t s tf.  We  will  suppose  that  un  satisfies  all  the  constraints 
placed  upon  the  Input  and  that  xn  satisfies  both  the  path  and  terminal 
constraints  placed  upon  the  vehicle  trajectory. 

The  actual  trajectory  of  the  vehicle  will  deviate  from  the  nominal  for  an 
assortment  of  reasons.  The  controller  output  may  be  up  Instead  of  un; 
the  trajectory  may  begin  at  a point  not  equal  to  ? Q;  the  differential 
equation  of  describing  the  vehicle  motion  may  differ  from  (D-3)  in  some 
way*,  etc.  Denote  the  actual  vehicle  motion  by  xp  and  the  actual  control 
signal  by  up.  The  deviation  In  trajectory  and  control  is  given  by  the 
pair  (x,  u)  where 


x » x„  -x„ 
P n 

u ■ u.  -u„ 


(D-5) 
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Siiv.  x and  u represent  deviations  from  the  ideal  trajectories  given 
by  (x  , u ),  it  Is  natural  to  try  to  make  them  as  small  as  possible.  Un 
fortunately,  (x,u)  Is  a vector  time  function  and  polntwlse  minimization 
is  Impassible.  Furthermore,  since  (x,u)  represent  all  of  the  vehicle 
characteristics  unmodeled  by  (D-3),  the  dynamics  of  the  perturbation 
variables  are  difficult  to  quantify. 


Certain  assumptions  and  approximations  make  the  problem  simpler  to  solve. 

It  will  he  assumed  that  (D-3)  represents  the  vehicle  dynamics  and  there 

Is  an  error  In  the  starting  point  of  the  trajectory;  l.e.,  the  initial 

condition  on  x„  differs  from  x . 

P n 

xp(t0)  t xn(tQ) 

Further  (x,u)  will  be  assumed  to  be  small  enough  that  the  dynamical  equa- 
tions of  the  perturbation  variables  are  given  to  an  adequate  degree  of 
closeness  by 


x ■ Fx  + Gu 


V,!,f 


x(to>  ■ yv  - V'o1 


where 


F 


3_f 
3 x 


G 


12 

3 u 
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(D-7) 


D-G 


For  the  system  described  In  (D-2)  F and  G are  given  by 


Hr 


where 


'-V  slny  co$4>  -V  cosy  »1nU*  0 0 
-V  slny  s1n4»  V cosy  cos^  0 0 
. V cosy  0 00 


-V"^cos$  V‘*A  s1n<|i 

si n ^ A cos$ 

V cosy  V cosy 

-a  0 

0 -b 
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(0-9) 


(0-10) 


All  of  the  control  and  trajectory  variables  are  evaluated  on  the  nominal 
trajectory.  The  matrix  F Is  time  variable  on  the  trajectories  of 
Interest,  but  the  accelerations  are  such  that  the  variation  Is  "slow" . 

D-l.2  Time  Domain  Controller  Definition 

There  are  several  properties  which  the  controller  should  possess.  First, 
It  should  be  a full  state  feedback  policy.  Further  the  control  algorithm 
must  have  a simple  structure,  linear  control  rules  provide  a large  class 
of  easy  to  mechanize  controllers  and  attention  will  be  restricted  to  this 
class.  The  closed-loop  system  must  be  asymptotically  stable  about  the 
nominal  trajectory  and  must  follow  the  nominal  with  small  errors.  In 

*To  simplify  notation  the  dimensions  of  null  and  Identity  matrices  will 
not  be  given  If  obvious  from  the  context. 
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addition  It  is  desirable  that  the  controller  be  robust  in  the  sense  that 
if  the  dynamic  equation  of  perturbation  variables  differs  from  that 
given  In  (D-6),  the  closed-loop  system  response  will  still  be  satisfac- 
tory. 

To  produce  a suitable  contoller,  an  Index  of  controller  performance  will 
be  Introduced.  Since  xp  should  track  *n  as  closely  as  possible,  x should 
be  minimized.  To  measure  the  closeness  In  tracking  at  time  t a quadratic 
weighting  will  be  used*,  x(t) 'Q(t)x(t)j  where  0 Is  positive  semldefinlte 
symmetric  (QsO).  To  minimize  the  deviation  in  control  from  that  re- 
quired on  the  nominal  trajectory  a quadratic  measure  will  also  be  used; 
u( t ) 1 R( t) u( t)  with  R > 0 (the  specific  value  of  R Is  given  in  Reference 
D-l) . Finally  terminal  miss  will  also  be  weighted  In  the  performance 
Index  with  a quadratic  term;  x( t^) ' P^x< tf ) with  Pf  a 0.  The  full  per- 
formance Index  Is  the  generalized  sum  of  the  weightings  at  all  of  the 
time  points  along  the  trajectory; 

J - x(t)'Pfx(t)  */V(t)Q(t)x(t)  + u'(t)R(t)u(t)]dt  (D_n) 


It  is  well  known  from  linear  regulator  theory  that  the  control  policy 
which  Is  best  with  respect  to  the  indicated  measure  of  performance  Is 
given  by 


u ■ -R“1G'Px 


(D-12) 


P ■ -F'P  - PF  + PGR^G'P  - Q 
P(tf)  - Pf 


( D- 13 ) 


The  control  policy  given  by  ( D- 11 ) has  many  of  the  properties  considered 
to  be  desirable  In  this  application.  It  Is  linear  with  time  variable 
gains.  Furthermore,  the  system  Is  stable  If  the  model  (D-6)  satisfies 
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certain  technical  conditions  which  will  be  considered  In  detail  In  later 
sections  of  this  appendix. 

Furthermore,  (D-12)  Is  robust  control.  Suppose  that  the  true  representa- 
tion for  x should  satisfy  an  equation  of  the  form 

x • Fx  + Su  w 

CD-14) 

x<‘o>  ■ w • xn!to> 

whe^e  w Is  a high  frequency  random  disturbance  and  tho  coefficient  mat- 
rices (?,G)  differ  slightly  from  (F,G)  given  by  (D-7).  The  random  forc- 
ing term  w could  represent  the  Influence  of  turbulence,  atmospheric  1n- 
homogenetl es , unmodeled  high  frequency  vehicle  dynamics,  etc.  The 
elements  In  the  coefficient  matrix  may  change  because  of  changes  In  the 
lift  and  drag  coefficients,  etc.  It  Is  well  known  that  even  In  the  pre- 
sence of  unmodeled  high  frequency  disturbances,  the  linear  feedback 
control  given  by  (D-12)  performs  the  path  following  and  stabilization 
functions  In  the  best  possible  way.  In  addition,  this  controller  gives 
the  closed  loop  system  the  property  of  having  a uniformly  smaller  sensitiv- 
ity to  parameter  variations  than  that  exhibited  by  the  open-loop  system. 

The  control  policy  given  by  (D-12)  has  many  favorable  attributes  In  the 
application  under  study.  The  general  form  given  by  (D-12)  and  ( D- 1 3 ) 

Is  broad  enough  to  Include  all  of  the  controllers  which  might  reasonably 
be  studied  at  this  stage  In  the  Investigation.  The  fundamental  problem 
in  design  Is  the  selection  of  the  appropriate  weighting  matrices  In  the 
performance  Index.  This  choice  must  be  made  judiciously  In  order  to 
simultaneously  provide  adequate  path  following  performance  and  a ter- 
minal miss  within  specified  bounds. 
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D-1.3  Selection  of  Weighting  Matrices- 

Although  the  controller  given  by  (D-ll)  has  all  of  the  previously  listed 
attributes  for  any  permissible  choice  of  (P,Q,R),  system  performance  may 
still  be  unsatisfactory.  For  example,  although  the  closed-loop  system  Is 
asymptotically  stable,  It  may  be  Inadequately  damped.  Effecting  changes 
In  the  closed-loop  damping  Is  accomplished  by  modifying  the  weighting 
matrices  of  (D-ll),  but  unfortunately  It  Is  not  Immediately  evident  how 
(P,q,R)  should  be  changed. 

For  some  purposes  It  Is  more  convenient  to  study  vehicle  motion  In  a 
rotated  coordinate  system.  Let  T be  the  coordinate  transformation 
given  by 


wheru 


/cosy  cos^i 

cosy  sln^ 

slnY 

Tu- 

1 -slnip 

cos^ 

0 

\-s1ny  cosvp 

-slnY  5 1 ntp 

COSY 

It  can  easily  be  shown  that  If  we  let  z represent  the  perturbed  state  In 
the  rotated  coordinate  system;  i.e., 

z - Tx  (D-16) 

then  (see  Reference  D-3,  (A-3)  and  Reference  0-3) 

z ■ Fzz  + Gu  (u-17) 
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where 


A iliw  slnv 
V coi^y 


0 

V COSY 
0 
0 


»V*^CQ$t|l 

■JlffL. 

V COSY 


-VA  slrty 

V cosy 
0 


This  change  In  state  variable  representation  resolves  the  vehicle  motion 
Into  a component  along  the  velocity  vector^,  an  orthogonal  component 
In  the  plane  of  the  motion  z^,  and  third  component  perpendicular  to  the 
plane  of  vehicle  motion  z2. 

The  uncontrolled  system  given  by  (0-17)  has  anomalous  stability  proper- 
ties. To  Illustrate  these,  consider  the  case  In  which  the  coefficients 
In  (F2,  6)  are  slowly  varying,  l.e., 


Y,  are  small 

A,  V are  constant. 

The  stability  of  the  open-loop  system  Is  partially  characterized  by  the 
open-loop  poles  which  are  In  turn  given  by  the  eigenvalues  of  Fz>  Direct 
calculation  (see  Reference  0-2,  (23))  shows  that  these  eigenvalues  { \ ^ > 
are  located  at  points  given  by 


(Xi>  • |o,  0,  0,  t j ^T2  + y2*  , -a,  -b| 


10- IB) 


tf  z Ts  a vector,  Is  Its  1th  component.  The  vector  z^  is  a unit 
vector  In  the  1th  direction. 
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Only  those  poles  attributable  to  the  autopilot  are  in  the  left  half  plane 
The  poles  of  the  vehicle  are  all  on  the  Imaginary  axis  and  Indeed  there 
are  five  poles  very  near  the  origin.  While  a system  with  poles  given  by 
(0-18)  could,  under  very  unusual  conditions  be  stable,  It  could  never  be 
asymptotically  stable.  Only  through  feedback  can  the  system  be  made 
asymptotically  stable. 


Because  of  the  lack  of  open-loop  damping,  the  existence  of  a feedback 
controller  which  will  stabilize  the  closed-loop  system  depends  upon  the 
satisfaction  of  a technical  condition  on  |V2,Gj  • The  condition  Is 
called  controllability.  A controllable  system  Is  one  In  which  any 
Initial  error  can  be  eliminated  with  a linear  feedback  control  law  In 
an  arbitrarily  short  t1ma*._  The  property  of  a controllable  system  of 


relevance  here  Is  that  If 
system  given  by  (Q-6)  and 


(0-1 


Is  controllable  then  the  closed-loop 


12)  Is  asymptotically  stable. 


Under  the  assumption  that  the  coefficient  matrices  are  sufficiently 
smooth,  an  algebraic  condition  for  controllability  can  be  deduced. 
Define  the  matrix  sequence  | ( t)|  by 


yt) 


G(t) 


(0-19) 


Mk+i(t)  - -F(t)Mk(t)  + Mk(t);  k - 0.1,... 


Then  let 


(0-20) 


* This  Is  actually  a strong  form  of  controllability,  but  this  definition 
will  suffice  for  the  system  under  study  here. 
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The  system  described  by  (D-6)  is  instantaneously  controllable  if  rank 
Cn(t)«n. 

The  matrix  Cn(t)  given  by  (D-20)  bears  striking  resemblance  to  the 
controllability  matrix  Cn  for  a time  Invariant  system.  Indeed  It  Is 
oasy  to  see  that 

rank  Cn(t)  ■ rank  Jg,  F^G,... ,F2n“*G] 

If  ^Fz»Gj  1*  a constant  matrix. 

In  Reference  0-2  both  CH  and  C*  were  studied  and  It  was  shown  that 

n n 

rank  Cn  • 6 (D-21a) 

rank  Cn(t)  - 7 (D-21b) 

The  Implication  of  (0-21)  Is  Important  in  this  application.  Equation 
(D-21b)  Is  sufficient  to  guarantee  that  closed-loop  system  guidance  law 
displayed  In  (0-12)  Is  asymptotically  stable  for  appropriately  restricted 
weightings  In  (D-U).  Equation  (D-21a)  Indicates  that  the  degree  of  sta- 
bility may  be  Inadequate.  To  see  why  this  Is  so,  a careful  study  of  the 
implications  of  uncontrollability  Is  required.  The  state  space  of  linear 
system  may  always  be  decomposed  into  a set  of  states  or  modes  that  are  con 
trollable  and  a residual  set  which  are  uncontrollable.  These  former 
modes  are  always  stablllzable  by  linear  feedback  while  the  latter  are 
unaffected  by  linear  feedback.  If  the  uncontrolled  modes  are  not 
asymptotically  stable  the  closed-loop  system  will  not  be  asymptotically 
stable  either. 


The  system  In  question  Is  controllable  but  for  any  fixed  time  say  t*  the 
matrices  [V2(t*),  G(t*)  do  not  satisfy  the  conditions  for  time  Invari- 
ant controllability.  The  system  could  be  described  as  being  locally 
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uncontrollable  mode  which  rotates  with  time.  Detailed  analysis  shows 
that  the  locally  uncontrollable  direction  In  state  space  rotates  among 
the  eigenvectors  of  F (t)  which  have  zero  damping.  The  system  Is  then 
said  to  be  locally  nonstabll Izable  In  the  sense  that  for  every  fixed  t, 
the  constant  matrix  [lrz»s]  is  not  stabilizable.  If  £fz,g!  were  a 
rapidly  varying  function  of  time,  no  adverse  effect  would  be  expected 
from  these  local  properties.  Unfortunately,  the  nominal  trajectory 
considered  for  this  vehicle  results  In  very  slowly  varying  dynamic 
matrices  In  (D-6),.  It  Is  to  be  expected,  therefore,  that  the  closed- 
loop  system  will  exhibit  peculiarities  normally  associated  with  un- 
controllable systems. 

The  above  qualitative  discussion  can  be  made  more  precise  by  reference 
to  Cj ( t) . Denote  by  the  set  of  vectors  In  R7  orthogonal  to  both 
columns  of  Mj ; 1 .e . 

^j(t)  ■ | t:  zcR7,  z'Mj(t)  - [0,0]} 

and  let  9£j(t)  be  Its  complement.  Define  the  positive  definite  matrix 
W(tj,t2)  by 

W(tl’V  'f*2  ♦2(t:.OG(T)R“1(t)  G'(x)  ♦,z(t1,T)dT 

h 

where  $z  Is  the  transition  matrix  of  Fz.  It  can  be  shown  (Reference  D-3) 
that  If  z(t1)  Is  an  eigenvector  of  W(tl,t1  +d)  and  if 

1 —1  -jar 

z(tj)c  u . then  for  small  AjZUj)  can  be  transferred  to  the 

R*°  -(1+21) 
origin  with  control  energy  proportional  to  & , The  Implication 

of  this  result  Is  Important.  For  example,  if  z(tQ)  Is  a linear  combi- 
nation of  columns  of  G,  the  error  can  be  eliminated  by  direct  action  of 
u and  the  energy  Is  proportional  to  Moreover,  if  za  and  z0  are 
orthogonal  eigenvectors  of  W(tQ,t0+A)  and  if  *u'Mj(t0)«  [Wj.O]  , 


'I  ‘i.-..  il  ill. - 1 . * — i ftlL  j_gJsL 
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z'M.(t)  ■ [O.wJ  . then  the  energy  required  to  transfer  z^  to  the 


origin  is, for  smallA, 


(?) 


times  that  required  to  cause  a similar 


transfer  of  zfl  to  the  origin.  The  direction  zfl  is  said  to  be  more 

8 «...  1 B 


controllable  than  zu  by  the  factor 


a 

w 

l 


Clearly  if  z ( t ) o “7? j ( t ) for 


all  (j,t),  It  can  not  be  transferred  to  the  origin  at  all. 


Applying  these  considerations  to  the  system  described  by  (D- 17) 
some  rather  Interesting  system  properties  can  be  deduced.  Assuming  that 
the  system  coefficient  matrices  are  slowly  varying,  that  i<<Y,  that 
a»b  and  that  (|>nom  « 180°  It  Is  shown  In  Reference  D-3  that  to  first  order 


Cl.  (5fil  z7)ea^0  and  zg  and  z^  are  equally  controllable 

C2.  (z5.  z4)e  ^fl^and  zg  Is  more  controllable  than 

z4  by  the  factor  A(cosY  )-1 

C3.  (z3,  z2)c  <^2  fl  -f|0  fl  and  z^  Is  more  controllable 

than  z3  by  the  factor  A 

C4.  ZjC  n-)|2  and  the  energy  required  to 

eliminate  errors  In  Zj  is  proportional  to  Y 

Relations  Cl  through  C4  provide  measures  of  the  relative  controllability 
of  pairs  of  modes  of  the  system.  They  are  based  upon  u(t)'u(t)  as  the 
power  measure.  The  components  of  u are  actually  related  to  different 
physical  quantities  and  a better  weighting  for  power  would  probably  be 
u'Ru.  Such  a power  weighting  measures  not  only  the  magnitude  of  the 
components  of  the  actuating  signal  but  also  minimizes  them  with  respect 
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to  their  permissiable  size. 


Since  R>0,  (D-6)  can  be  written  in  the  form 
x • Fx  + QR-1*  (rSi) 


(0-22) 


As  (0-22)  makes  clear,  the  controllability  Indices  given  In  C1-C4  can 
be  modified  to  provide  controllability  with  respect  to  u'Ru  if  GR  is 
used  in  (0-19)  Instead  of  G.  This  is  easily  done  when  R is  given  by 


R ■ diag 


1 


(D-126) 


max 


A? 


max. 


where  AAmax  and  A$max  are  the  maximum  permissible  magnitude  variations 
in  the  actuating  sinnals. 

It  can  be  shown  that  C1-C4  become 

Cl'.  z6  and  z7  are  equally  controllable 

C2*.  2S  is  more  controllable  than  z4  by  the  factor 


AA  <t 


max 


AA 


max 


COSY 


C31 . z2  is  more  controllable  than  z^  by  the  factor 


AA$ 


max 


-1 


A A 


max 


C41.  The  energy  required  to  eliminate  errors  In  z,  is 

- o A 


proportional  to  Y 


-2 


0-16 


With  the  relation  given  In  Cl'  -C4*  we  are  in  a position  to  make  a 
judicious  choice  of  the  state  weighting  matrices  P and  Q.  Since  the 
conditions  are  stated  In  the  ^-coordinate  system,  the  weighting  matrices 
P2  and  Q2  corresponding  to  this  coordinate  system  will  be  found  first. 

The  states  zg  and  z7  are  autopilot  states  and  there  are  no  penalties 
associated  with  their  variation.  Consequently  a reasonable  choice  for 
their  weighting  would  be 


(Q,) 


z'66 


fly- 


77 


(0-24) 


The  states  z^  and  zg  are  flight  path  and  azimuth  errors,  respectively. 
Suppose  these  errors  are  required  to  stay  within  nominal  bounds  given 


by  qci  1 .a.. 


max 

t 


*4*4IS 


v 


(D-25) 


The  usual  rule-of-thumb  for  selecting  (Q2)^  and  (Q2) 55  would  be 
fly 44  " ^56  “ q2 2 


Suppose  Xj  > 1.  Then  zg  Is  easier  to  control  than  by  the  factor 
For  equal  Initial  errors,  the  residual  error  In  z4  at  times  greater  than 
tQ  will  tend  to  dominate  that  In  zg  because  of  the  difficulty  In  applying 
effort  to  z^.  To  cause  the  closed-loop  damping  in  these  two  modes  to  be 
more  nearly  the  same,  a heavier  weight  should  be  assigned  to  z^.  The 
weighting  of  z^  will  be  Increased  by  the  factor  Xj  while  maintaining  the 
same  overall  angular  deviation;  l.o., 
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<V44  * W«)Sb  ■ 2 "Z 

This  yields 

2 Xj2  , 

(Ql)44 ' 7TT7  q*  1 


^44  - X 2 

W.»M  ' 1 


«4>5S  ‘ ~ T V 


(D-26) 


It  Is  readily  apparent  that  (0-26)  provides  suitable  weightings  when 
X j s 1 as  well . 


The  Important  trajectory  variables  are  Zj  and  z3  which  measure  errors 
orthogonal  to  the  nominal  trajectory.  Reasoning  as  we  did  In  the 
previous  paragraph  If 

max  /z|  + z2  ] s -^jr  (D-27) 

t \ ' ql 


then 


<qz^22 


1 + 


(Qz) 


33 


(0-28) 


The  final  state  variable  measures  motion  along  the  nominal  velocity  vector 
vector.  As  C4‘  Indicates  errors  In  this  direction  are  quite  difficult  to 
control.  Errors  In  z^  require  energy  proportional  to  Y ‘‘to  correct 
and  Y is  fairly  small  In  this  problem.  It  Is  easy  co  see  the  physical 
cause  of  the  difficulty  in  controlling  Zj.  Neither  normal  acceleration 
nor  bank  angle  commands  create  any  first  order  change  In  tangential 
velocity.  If  the  flight  path  angle  were  constant  ( Y ■ 0)  errors  along 
the  velocity  vector  could  not  be  eliminated  (the  system  Is  not  stablllz- 
able).  Since  Y t 0 we  have  some  control  over  Zj.  This  Is  accomplished 
by  shortening  or  lengthening  the  turning  radius  of  the  vehicle.  To 
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accomplish  regulation  of  path  length,  sizable  amounts  of  control  force 
are  required  to  produce  small  variations  In  iy  Because  of  this  very 
weak  coupling  between  u and  z^,  if  z^  has  a weighting  in  Qz,  u will  have 
a tendency  to  give  excessive  attention  to  this  error. 


If  the  absolute  time  of  evolution  along  the  trajectory  is  of  little 
concern,  the  system  can  be  made  Insensitive  to  tangential  errors  by 
making  (Qz)^  ■ 0.  In  this  specific  application  this  is  a reasonable 
choice  since  terminal  impact  performance  Is  of  primary  concern. 


The  final  form  of  Q2  Is  then: 


2 Xp  2 2 2 

Q_  ■ dlag  [0,  y q,  . y <li  . 

1 V i + A i + \z 


CD-29) 


111  - 2 2 *2 


1 + X 


? q2 


1 + X 


, o,  0 


n 

where  are  given  In  02*  and  C4'  and  q.,  are  given  in  (0-25) 

and  (D-28) 


For  the  reasons  outlined  above,  the  only  terminal  errors  are  those 
associated  with  errors  perpendicular  to  the  flight  path.  If 

Zg(t^)2  + Z2  (tj,)  S (0-30) 

q3 


a reasonable  choice  of  Pf  would  be 


/ 2X22 
dlag  0,  a- 

\ 1+x2 


L 


0 


(D-3I) 
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Equations  (D-23),  (D-29),  and  (D-31)  give  the  weighting  matrices  in  the 
z-coordinate  system.  The  actual  observations  and  calculations  take  place 
in  the  x-coordinate  system.  It  is  shown  in  Reference  0-2  that  an 
optimization  problem  in  the  z-coordlnate  system  with  respect  to  the 
weighting  (p2*Q2'Rz)  equivalent  to  the  optimization  problem  In  the 
x-coordlnate  system  parameterized  by  ( T ' P2T»T'Q2T«R2) . Using  the  value 
of  T given  In  (0-15),  It  follows  that 


in 


ir  1 
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where 


Qll  " 77(pf5ll 

<3 


*Z2 


diag 


2 X 


1 + X 


1 Q 2 
7 q2 


1 


J_V 

1 + X 


. 0,  0 


(D-36) 

(0-37) 


1 


Equations  (0-23),  (0-33),  (0-34),  (D-36),  and  (0-37)  give  the  final 
system  weighting  matrices  for  this  design  problem. 


0-1.4 


An  Example 


The  previous  section  provides  a procedure  for  selecting  the  weighting 
matrices  to  be  used  in  the  synthesis  of  a vehicle  guidance  law.  To 
Illustrate  the  utility  of  these  weighting  matrices  a simple  example  Is 
useful.  In  this  example  two  controllers  will  be  compared.  The  first  Uj 
will  use  a modification  of  the  techniques  presented  above  while  the  sec- 
ond will  use  weighting  matrices  which  might  have  been  chosed  after 
viewing  the  open-loop  simulation. 

To  Isolate  the  Influence  of  the  coordinate  transformations,  (P,  Q,  R) 
have  been  kept  as  close  as  possible  for  the  two  controllers  Denote 
the  weighting  matrices  associated  with  control  i by  (P^.Q^.R^). 

Then 


R1  « R2  " diag(r1,r2)  (0-38) 

The  scalar  r^  measures  the  perturbed  acceleration  along  the  nominal  tra- 
jectory. Its  calculation  is  detailed  In  Reference  0-5.  Suffice  it  to 
say  that 
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with  a smooth  monotonic  variation  in  between.  The  perturbation  in  bank 
angle  was  restricted  to  about  10°  and 


r2(t)  - - 25 


(D-40) 


Equations  (D-39)  and  (D-49)  give  R for  this  problem. 


The  nominal  trajectory  used 
i|i(t)  « 0 ; A(t)  5 1600,  25°SYS65° 
From  (0-142)  - (0-144)  we  see  that 


(0-41) 


A „ c Cl, 8] 

2 1.6  x 10J  (.2) 


(0-42) 


X , .[I,  2>5] 

' ^nax  cos 


(0-43) 


Because  it  is  believed  that  the  method  of  computing  4Afflax  gives  rise  to 
excessively  large  values,  it  has  been  decided  to  approximate  \2  and  by 


^ 3 1 


(D-44) 


The  choice  of  is  based  upon  an  allowable  position  deviation 


from  the  nominal  of  6 x 1CT  at  t and  10'  at  tf. 


u-y 


q1  - 6000  - 5990 


(D-45) 


The  weighting  on  x4  andXg  Is  deduced  from  permitting  1°  of  angular 
deviation  in  fl ight;  1 .e. , 


q0  ■ 57.3 


.»■  i . ■ 


Substituting  (0-41),  (D-44),  (0-45),  and  (D-46)  Into  (D-36) 


f 


I 

I 

I 


2 2 2 
q1  sin  y 0 -qj  slny  cosy 


0 q. 


2... 2. 


-q^  slnY  cosy  0 q1  cos  y 


O 


(D-47) 


o 


^ 3 


Although  there  Is  no  Importance  attached  to  terminal  deviations  In  x^  and 
Xg,  for  reasons  of  computational  simplicity  P^  was  chosen  as 

Pj  “ QjUf)  (D-48) 

Equations  (D-38),  (D-47),  and  (D-4t  give  (P^,  Q^,  R^) , 

The  second  controller  u2  Is  parameterized  by  the  weighting  matrices 
(Pj,  Q2>  R2).  ^e  matrices  ( Pg » Q2)  differ  from  (P^  Q^)  only  In  that 
they  are  not  rotated  to  conform  to  the  z-coordlnate  system  and  no  penalty 
Is  accorded  to  deviations  In  the  altitude  coordinate  z.  As  was  observed 
In  Reference  0-3,  for  the  trajectory  of  interest,  no  penalty  on  devia- 
tions In  the  altitude  yields  a zero  gain  for  altitude  perturbations. 

To  compare  system  performance  with  the  two  guidance  laws,  the  results 
of  a simple  example  are  Instructive.  For  the  guidance  law  u^.  the 
weightings  (P^,  Qj,  R^)  are  given  In  (D-38),  (D-47),  and  (D-48)). 

For  guidance  law  u2 
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^2  * ^ * ^2  " ^1 


(0-49) 


A simple  trajectory  contained  In  the  (x^.  Xg)  plane  was  examined; 

X1  (tQ)  ■ 6 x 103  X(tQ)  • order  105 
X1 (t0)  * 0 ; 1 M Z(t0)  ■ order  105 
t0  ■ 0 , tf  » 8 


Some  Important  qualitative  features  of  the  system  response  are  shown 
In  Figure  D-2.  The  trajectory  associated  with  control  u,  is  denoted  by 
xp1'  ^9ure  is  not  drawn  to  scale  In  order  that  effects  attrib- 

utable to  the  difference  In  controllers  can  be  made  more  apparent. 


All  of  the  trajectories  begin  at  the  same  point  but  xp2  crosses  xn  and 
terminates  below  It.  The  trajectories  have  the  properties  which  would 
be  expected  from  their  respective  performance  Indices.  The  guidance 
law  Uj  reduces  the  magnitude  of  the  error  and  rotaes  its  direction  so 
that  it  Is  aligned  with  the  velocity  vector.  The  guidance  law  u2  on  the 
other  hand  rotates  the  error  essentially  Into  elevation. 

The  character  of  xp2  has  one  anomaly  deserving  comment.  The  matrices 
(P2»  Q2)  attach  no  penalty  to  shifts  In  elevation  and  so  It  Is  to  be 
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Figure  D-2  Perturbed  Trajectories 
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expected  that  xp2  wou^d  take  the  form  of  a motion  "parallel " to  xn; 

1.e.f  a motion  having  the  same  direction  but  vertically  shifted.  On 
this  basis  another  trajectory  denoted  by  xp2  aPP®ars  to  be  a more 
likely  candidate  for 'the  trajectory  because  It  Is  "parallel"  and 
presumably  takes  less  energy  to  accomplish.  The  flaw  In  this  line  of 
reasoning  Is  that  more  than  "paralleT1  motion  is  required  if  the  penalty 
accorded  by  (P2,  Q2)  Is  to  approach  zero.  "Parallel"  motions  with  time 
translation  give  rise  to  positive  penalities  because  of  a perceived 
error  In  x.  Observe  that  u2  must  "slow"  the  system  before  moving  Into 
a"parallel"  path.  This  slowing  Is  accomplished  by  having  xp2  cross  *n, 
and  producing  an  Increase  In  path  length  thereby.  For  reasons  discussed 
earlier,  this  leads  to  a considerable  Increase  In  the  energy  required 
from  the  guidance  law.  To  "slow"  the  vehicle,  the  weakly  controllable 
mode  must  be  excited  and  this  necessitates  an  Increase  In  the  size  of 
the  actuating  signal.  For  the  specific  sample  trajectory  x 2 requires 
roughly  twice  the  energy  required  by  x 

Table  D-l  gives  relative  performance  of  u1  and  u2  at  impact  for  various 
Initial  errors  and  parameter  variations.  In  every  case  Uj  provided 
superior  performance . Though  It  Is  probably  true  that  u2  Is  Inferior 
to  other  controllers  that  could  have  been  selected  empirically,  this 
example  illustrates  that  the  system  designer  Ignores  the  relative 
stability  of  the  system  modes  at  his  great  risk.  Only  by  explicitly 
modifying  the  performance  penalties  can  the  available  guidance  energy 
be  allocated  In  the  most  appropriate  way, 

D-l. 5 Summary 

In  tnls  section  a methodology  for  synthesizing  a guidance  law,  based 
on  the  Linear  Quadratic  Regulator  theory,  and  the  associated  weighting 
matrices  has  been  developed.  In  this  formulation  the  relative  con- 
trollability of  the  different  system  modes  enters  directly  Into  the 
system  penalty  function.  The  point  of  view  espoused  here  differs  from 
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Table  D-l.  Guidance  Law  Comparison 


Impact  Deviations 

Guidance  AX  Ay  At  A Mach 

Perturbations  Law  (ft) (deg)  (sec)  ( - ) 

.11  .21 

.09  .16 


Initial 

downrange 

error 


652. 

-10. 


3.8 

0.9 


Initial 

u2 

-2773. 

-6.9 

-.36 

.09 

altitude 

“1 

-151. 

-2.9 

-.33 

.19 

error 

Density 

u2 

377. 

-2.0 

.06 

-.50 

perturbation 

«, 

-3. 

0.1 

.05 

-.50 

* Comparison  by  analysis 


of  the  linear  response 


D-2i 


t 


that  typically  used  in  that  P and  Q are  usually  constrained  to  be  diagon- 
al and  equal  weightings  are  assigned  to  states  that  are  Intended  to  have 
equal  deviations.  It  is  the  fundamental  point  of  this  discussion  that 
equal  penalties  do  not  cause  "equal"  responses.  Indeed,  just  the  oppo- 
site Is  true.  Equal  weighting  on  states  will  tend  to  preserve  relative 
responses  in  closed-loop  that  the  states  had  in  open-loop.  Weightings 
modified  by  the  relative  controllability  properties  of  the  states  will 
tend  to  counteract  this.  Though  the  problem  is  conceptually  simpler  than 
that  studied  by  Skelton,  Reference  D-4,  this  procedure  is  similar  In 


effect  to  that  of  Skelton  In  that  the  dlfficult-to-control  directions 
are  Identified  and  greater  emphasis  is  placed  upon  them.  The  closed- 
loop  controller  is  expected  to  display  more  uniformity  in  its  response 
to  Initial  errors  in  different  directions  than  would  one  not  employing 
the  controllability  factors. 


In  addition,  the  analysis  of  the  controllability  Illustrates  the  diffi- 
culties associated  with  any  guidance  law  for  this  system,  and  for  systems 
with  similar  characteristics,  which  Is  based  upon  the  use  of  time  as  the 
system  variable  of  evolution. 
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0-2.  STATE  VARIABLE  AS  VARIABLE  OF  EVOLUTION 

In  this  section  the  use  of  a state  variable  rather  than  time  as  the 
variable  of  evolution  of  the  system  Is  considered.  The  motivation  for 
this  approach  is  manifold.  Historically  it  was  observed  that  a reduc- 
tion In  the  number  of  states  carried  In  the  solution  of  the  matrix 
Rlccatl  equation  reduces  significantly  the  time  requirements  for  target- 
ing the  optimal  control  guidance  law.  Another  concern  In  the  case  of 
a maneuvering  reentry  vehicle  Is  the  uncertainty  In  the  time  to  begin  the 
process.  Clearly,  the  use  of  a state  variable  for  the  independent 
variable  provides  benefits  In  the  above  areas.  Previous  studies,  prim- 
arily motivated  by  the  above  considerations,  found  that  performance  was 
improved  through  the  use  of  a state  variable  rather  than  time.  The 
reason  for  the  Improvement  Is  that  when  time  Is  used  for  the  variable 
of  evolution  the  controller  not  only  tries  to  control  the  state  variables 
to  follow  a space  curve  but  also  tries  to  control  the  rate  at  which  the 
space  curve  Is  traversed.  Such  control  applies  some  of  the  resources  to 
the  control  of  the  least  Important  part  of  the  problem,  in  this  case  the 
time,  rather  than  concentrating  on  the  most  Important  part  of  the  prob- 
lem, the  steering  of  the  vehicle  along  the  desired  space  curve.  For 
example,  suppose 

xp(t0)  ■ where  f ^ satisfies 

xn(tt)  • 1 tj  >tQ 

1 . e . because  of  clock  errors  In  the  vehicle,  the  control  process  begins 
on  the  desired  trajectory  but  with  a time  error  of  (tj-tQ)  seconds.  The 
LQ  controller  using  0-6  and  0-12,  however,  perceives  this  time  error  as 
a state  error  and  tries  to  remove  it.  It  thus  overcontrols  the  vehicle 
trying  to  eliminate  errors  that  are  of  no  Importance.  Similar  behavior 
occurs  If  the  aerodynamic  drag  Is  greater  than  the  nominal. 
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D-2.1 


System  Equations 

The  basic  problem  of  order  reduction  by  change  of  independent  variable 
can  be  posed  in  the  following  way.  Let  the  system  dynamics  be  described 
by  the  nonlinear  differential  equation  (D-3)  with  the  perturbation  var- 
iables defined  as  In  (D-5). 


Suppose  that  xn  and  xp  are  both  such  that  their  first  component  Is  mono- 
tone increasing;  l.e., 


V*!1  < xpl{t2> 

xnl(tl>  “ xnl<t2>  for  ‘2  > ‘l 


Since  xn  and  xp  are  continuously  differentiable,  either  one  could  be  used 
in  place  of  time  as  an  Independent  variable. 


Consider  first  x 


nl’ 


d x„ 


nl 


f(y  un> 
fl<Vunll 


From  Equation  D-3 
” fr  <Vn> 


(0-50) 


The  linear  variational  model  Is  obtained  from  (D-50)  by  perturbing  xn 
and  un  slightly  and  equating  first  order  terms.  Note  that  only  the  num- 
erator of  f Is  perturbed  and  not  the  denominator.  Because  this  does  not 
yield  the  gradient  of  f , the  associated  variational  equation  Is  non- 
degenerate; l.e.,  even  though 

frl  - 1 ( D-5 1) 
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It  Is  stm  true  that 


Carrying  out  the  usual  variational  arguments  on  (0-50),  a linear  evolu- 
tional equation  for  x as  a function  of  xnl  can  be  obtained  and  the  stan- 
dard control  problems  solved.  Note,  however,  this  design  problem  takes 
place  In  n-space  If  n Is  the  dimension  of  Xp. 

By  contrast  If  xp^  Is  used  as  an  Independent  variable,  the  problem 
becomes  conceptually  more  complicated.  There  Is  an  ensemble  of  functions 
{ x } , the  elements  of  which  are  parametrically  dependent  upon  the  per- 
turbations from  nominal  of  the  system  dynamics.  If  the  specific  xp 

realized  by  the  vehicle  were  known  a priori,  this  would  create  no  es- 
sential difficulty.  Unfortunately,  this  knowledge  would  violate  system 
causality  and  may  be  ruled  out  Immediately.  Furthermore,  the  one 
rationale  for  using  xpl  as  an  Independent  variable  Is  to  eliminate  the 
explicit  time. dependence  of  the  perturbed  trajectory  and  the  control. 

With  no  measure  of  absolute  time,  there  Is  no  way  to  calculate  x„  from 

n 

xp  and  consequently  no  way  to  compute  x. 

One  way  to  avoid  the  problem  of  loss  of  time  Information  Is  to  generate 
a pseudo  time  variable.  Suppose  at  time  t^,  xpl(t^)  Is  observed.  From 
this  Information  alone  tj  can  not  be  computed  because  x^(tj)  and  hence 
XniUj)  are  not  known.  It  is  possible,  however,  to  estimate  t ^ by  t^* 
where  tj*  satisfies 


That  Is,  the  first  state  variable  Is  posited  to  be  observed  without 
error,  and  the  nominal  values  of  the  other  variables  Inferred  from  this 
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observation . 


If  |tj*  - Is  small 

xnl^l*^  " xni^i)  * “ tj)  f \C xn( ^i)  un(tj) ) ( D— S3) 

From  (D-5) , (0-52),  and  (0-53) 


xnl^V  + fl^W  W*  * xnl*V  + W 


or 


x.(t,) 

(V“ti)  “ r1(^(t'J)"un(t'1yT 


(0-54) 


The  time  shift  Inherent  in  making  the  identification  shown  in  (D-54)  is 

proportional  to  the  unacknowledged  error  In  the  first  component  In  the 

state  vector.  Thus,  trajectory  errors  become  time  errors  under  (D-54). 

The  time  anomaly  Influences  the  perceived  vehicle  dynamics.  The  vehicle 

controller  using  xpl  as  an  Independent  variable  observes  errors  In  a new 

coordinate  frame  x„  where 
r 

xr(t1)  B xp(t1)  - Xn(tx*)  (D-55) 


Obviously 


a 0 
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as  the  controller  can  not  Identify  first  component  errors.  If  only  first 
order  terms  are  retained,  it  follows  that 


xr(tj)  - xp(t1)  - (x„( tx)  + (t1*-t1)f(xn,un)) 


xi(ti> 


■ W - X„(t1)  - f(Xn.U„) 

■ x(t.|  • -!■  f (vun> 


(D-56) 


Equation  (D-56)  shows  the  aliasing  of  time  errors  into  state  errors  In  xr. 
Errors  In  the  first  state  component  of  the  system  are  unmeasurable,  but 
they  are  reflected  in  the  perceived  errors  In  the  other  components  at 
the  state  vector. 


0-2.2  Vehicle  Dynamics  In  the  Perceived  Reference  Frame 


The  vector  xr  In  (D-56)  Is  the  perceived  error  state  of  the  system.  To 
provide  adequate  regulation  of  this  error,  Its  equation  of  evolution  must 
be  derived.  From  (D-3)  It  follows  that 

d(xp(t))-  (f(xn,un)  ♦ -||  x . -§£  u)dt 


d<  *P,(t))  ■ <fi f sir  * + sir  u>dt 


(D-57) 


Consequently 


“V*1  , dx [ t ) 

“ xpi'')  d xpl( 


<f  ♦ K x * U u)  t, 


• «r-.-  .*  - 


2 2 

where  terms  of  order  x and  u and  xu  have- been  neglected.  So 


L 


<*x(t) 

dxpl(t) 


( i u f )x  + (i  & f )u 

3x  "3T  3x  3u  T?  su  ' 


1 


1 


dx 


n 


+ f--'  3V 


( D— 58) 


Denote 


9f_  3 f y, 

L m p ; L a Q 

3x  r ’ du  r 


From  their  definition  It  follows  that 
1 3f 


f 3fl 


"r  " T.  3x  “ .2  3x 

T1 


- 1 3f  f 8fl 

V Tj  1u  • 7?  5T 


and  thus 


dx(t) 


Frx  + Cru  + fr  ‘ 3T7 
Pi 


(D-59) 


The  last  term  In  (D-59)  can  be  simplified; 


dx. 


f(Vun>  . f 


j 3 fj  1 9 


d*pl  ' fi<Xp'“p>  "fi(1  ‘ V*  X ' f 


f 3u 


u) 
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and 


dx 


f 3 ft  3 fi 

‘ * sr“  - ‘ST  u> 


dx 


Pi 


(D-60) 


Now  consider  the  change  of  variable  Indicated  In  (D-56) 


dx. 


(D-61) 


The  first  term  of  (0-61)  Is  given  In  (D-60).  The  second  term  can  be 
found  by  observing 


d f F d*n  - dun 

at  fr  Fr  at"  + Gr  ar 


(D-62) 


Frf  + Gr“n 


d x 


It 


Pi 


(0-63) 


where  only  zero' th  order  terms  In  the  expansions  have  been  retained  In 
(D-62)  and  (0-63).  Thus 


dxi  + Xj 


-= ( x,f  ) ■ fr  -r-±-  * -i  (F  f +G  u ) 

d xpl  ' 1 V 3x^Y  ^ r r n 


(0-64) 


Substituting  (D-64)  and  D-60)  Into  (D-61) 


dxr 

ar 


pi 


Fr(x  - xjfr)  + Gr(u  - un  -^)  - -ri  ( ar x • sir 


U) 


dx 


1 


(0-65) 
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From  its  defining  equation  It  is  apparent  that  the  first  row  of  Fr  and 


the  first  row  of  Gr  are  zero.  From  (D-60) 


d x.  , 3f,  3f, 

' - ~r1 x ♦ — “> 


Substituting  this  Into  (0-65) 


dx„ 


-i—  ■ F x +G  u 
xpi  r r r r 


(D-66) 


where 


. x 


ur  “ u ' un  7T 


( D-67 ) 


Note  that  the  system  equation  given  by  (D-66)  Is  degenerate  because 


xrl  - 


The  Interpretation  of  (xr>up)  Is  evident  from  Figure  D-3.  The  controller 


has  no  measurement  of  absolute  time.  By  assuming  that  xpl  ■ xnl,  It 
concludes  that  t « t*.  Actually 


1 


t*  - t ■ T- 


Not  realizing  this  error  means  that  at  time  t 


un<t*>  ■ un 


D-36 


Note  that  even  if 


!■  | 

r • 

l 

...  < 
i 

\ » 
f; 
v 

.1 


i 


; i 

l»  ' 

I 

i 

i 

I 


Xp(t)  ! xn(t*) 

Up(t)  J*  un(t) 

To  avoid  penalizing  control  deviations  that  are  due  only  to  absolute  time 
translations  In  the  trajectory  variables,  define  ur  as  a perturbation 
from  un(t*);  l.e. , 

ur(t)  ■ up(t)  - un(t*) 

■ u(t)+U-u(t)-  -tr  U 
nv  1 n'  1 f,  n 


This  Is  Identical  with  (D-67) 

In  the  perceived  coordinate  system  the  error  Is  xp  and  the  actuating 
signal  Is  ur.  With  (D-66)  we  are  now  in  a position  to  pose  to  a 
quadratic  regulator  problem. 

9 

D-2.3  Quadratic  Regulators 

Using  (D-66)  as  the  dynamic  model,  a quadratic  regulation  problem  can 
be  delineated.  Define 

*p^f5 

Ur'Qrxr  + VRrur)d*Pl  (D-68) 


J * xr(tf)Pp  xr(.tf)  + j 


D-38 
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The  cost  function  J measures  errors  in  the  perceived  coordinate  system. 

The  error  vector  x„  can  be  considered  to  evolve  in  Rn'^  since  x„,  3 0. 

r r 1 

To  facilitate  comparison  with  the  original  coordinate  system,  xr  will  be 
treated  as  an  n-dltnenslonal  vector.  Thus  QJs  n * n. 

r 

From  ( 0-56 ) 


x„  “ T„x 
r r 


(0-69) 


where 


- J 

T - T1 


0,  0 

f 


As  was  pointed  out  in  Reference  0-2  (pg  5);  the  problem  of  minimizing 
J in  (D-68)  is  identical  to  that  of  minimizing 


J • x(tf)P  x(tf)  + j (x'Qx  + ur'Rup)dx(. 


CD-70) 


where 


p ■ T ' P T , Q-T'QT 
r r r ' y r yr  r 
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It  is  interesting  to  observe  that  Tf>  is  singular.  Indeed 


T f 
r r 


0 


Hence 


VPf*  • f 'Qf„  - 0 

r r r P 

The  control  system  which  minimizes  (D-68)  or  ^9-70)  will  try  to  resolve 
the  residual  error  Into  the  f direction.  This  result  is  not  surprising 
when  the  motivation  for  selecting  Xp^  is  recalled. 

Since 


“ *pl  ' fl‘xn-un)dt 


It  follows  that 


J « x'rPrxr  + f 1 {xp'(Qrfj)xr  + uf,(Rrf1)ur)dt 


From  (0-67) 


ur'Rrur  ' <u  ‘ ^ "i>'Rr  ^ ^ ^ 


Thus 


(D-71) 


J • x P * 
r r r 


*/tf[X'(f  1 Wr'^WWl 


))x 


2u'R^u  T.x  + f,  u'R„u 
r n l i r 


dt 


where  Tj  ■ (1,  0,  . . .0) 
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In  the  time  domain  the  regulator  problem  becomes  somewhat  nonclassical 
because  of  the  Inclusion  of  cross  product  terms  in  the  integrand. 

In  the  problem  under  study  here,  ur  ' Rpur  is  a more  reasonable  measure 
of  control  power  than  u'Rru  and  so  we  will  say  that  (D-68)  is  equivalent 
to  a regulator  problem  In  the  time  domain  parameterized  by  matrices. 

(P.Q.R)  " (t;  PrTr,  f]  t;  QrTr,  f,  Rr)  (0-72) 

0-2.4  Changes  in  the  Independent  Variable 

It  may  happen  that  x ^ Is  absolutely  continuous  and  monotone  increasing 
for  only  a portion  of  the  trajectory.  It  would  then  be  advantageous  to 
change  Independent  variables  at  discrete  points  on  the  trajectory  to 
make  use  of  a different  trajectory  variable  with  preferable  properties. 
Let  ttji  1*1,  . . . i n)  be  .in  Increasing  sequence  of  points  1n[t0,  tf] 
and  suppose  that  the  Independent  variable  Is  changed  at  these  time 
points.* 

The  simplest  class  of  such  changes  simply  Involves  renumbering  the  states 
In  xn;  e.g.  xn^  becomes  x^  and  conversely;  f*  becomes  f^  and  conversely. 
Thus,  while  xpj  Is  the  generic  label  for  the  Independent  variable,  xp^ 
may  correspond  to  different  state  variables  along  tne  trajectory.  A 
change  In  Independent  variables  creates  a new  matrix  T(,(t)  at 

(Xp^(t^)}  and  consequently  xt,(t)  changes  discretely  at  these  same  time 
points: 


*r(tp  • ^(tp  x t yt^)  x • xr(ti+)  (0-73) 

’*  Second  orderr"errors  are  Introduced  by  assuming  the  change  of  variable 
is  time  based  rather  than  being  based  on  the  perceived  independent 
variable, 


0-41 


Although  T Is  singular,  (0-73)  can  be  used  with  an  additional  hypothesis 
to  find  the  change  in  xp.  The  vector  x can  be  decomposed  Into  a compon- 
ent along  f and  a component  orthogonal  to  f 

x(t)  ■ a(t)f  + x$(t) 


xr(t)  - 


*s(t) 


*m(t) 


x.M(t) 

sn 


Clearly 


*r(t*)  ■ Tr(tf)xs(tf) 


subject  to 


fxslt+)  ■ 0 


Equation  (0-73)  can  be  written 


V(tl  + ) “ fr(t1^N(tif) 

where 


t\L  fit'. 
+ -Ar  ) — r-1 

ty  ri 


' . f c 
(1  f -V) 

V -1 
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If  It  assumed  that  T is  nonsingular , then 


N“l*»  ‘ Vl(*1*):r(t1t) 


(0-78) 


Combining  (0-75)  and  (0-78) 

xs(ti+)  ‘ T/(0V(ti+) 


(D-79) 


where 


r -t. 


T#(t/) 


-f 


0 ( 


m ) f,.-1  (t,*i 


V1  (')*> 


(D-80) 


The  matrix  Tp  is  the  correct  pseudoinverse  of  Tp  in  this  problem 
because 


xr<V)  • Tr(t1')Tr#(ti  + )xT,(t1  + ) 
• r(t1)xr(tif) 


(D-80 


The  formalism  of  dynamic  programing  can  now  be  used  to  produce  the 
control  which  minimizes  subject  to  (0-87)  and  (0-81).  The  development 
is  routine  and  only  the  result,  is  of  Interest: 
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Vlxpl>  ’ #,-'1  V Vr 


■ -Fr‘Kr  - Vr  * KrQrSr"’  W "V  V »’ 

dxn1 

-Kr(xnl(ti’))  ♦ Kr(xnl(tH+))  - r(ti)‘Kr(xnl(t1+))r(t1)i  1-1. 
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Note  that  Fr  and  change  discretely  at  the  same  points  that  T,  does 
because  the  form  of  f changes  at  these  points, 

D-2 . 5 Introductory  Examples 


To  explore  the  implications  of  the  results  presented  thus  far,  and  to 
illustrate  the  mechanics  of  the  Indicated  transformations,  two  simple 
examples  are  useful.  As  the  first  consider  the  uncontrolled  motion  in 
the  plane  given  by 


V cos  y 

V sin  y 


(D-8J) 


where  V is  constant  and  y Is  a given  function  of  time,  monotonically 
increasing  and  0 < y <•  n/2  over  the  time  Interval  of  interest,  For  suit- 
able Initial  conditions  both  components  of  $ are  monotonic  and  we  will 
suppose  that  the  motion  given  hy  (0-03)  is  as  shown  in  Figure  D-d, 
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Suppose  X Is  used  as  the  independent  variable.  Then 


tan  y 


Fr-0 


0 0 


Suppose 


-tan  y 1 


Qr  » dlag  (0,  qfj),  Pr  « diag  (0,  p^) 


Then  (see  (D-72)) 


(D-84) 


P « p* 


2 tan  y tan  y 


2 tan  y 1 


2 tanY  slnY  sinY 

QBq2  cos^  slnY  cosy 


(D-85) 


Note  that  (V  co$Y,  V sinY)  is  in  the  null  space  of  both  P and  q and  hence 
any  errors  along  f will  not  be  penalized  by  either  P or  Q. 

The  method  of  selection  proposed  in  Appendix  D-1.2  attempted  to  achieve 
this  same  effect  by  use  of  the  transformation  , 


cosy  sinY 


-sinY  cosy 
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As  shown  in  Appendix  0-1.2,  Equations  D-26  and  D-27,  this  gives  normali- 
zed values  for  P and  Q of 

pw  • p22[  1 •cotl 

w 4 -coty  cot  Y 


sin^Y 

-siny  cosy 


-slny  cosy 

COS2y 


Comparing  (0-85)  and  (D-87) 
P - Pw  tan2y(tf) 

Q-qw 


(D-88) 


Thus  the  two  methods  provide  essentially  the  same  weightings.  The  dif- 
ference In  P and  Pw  is  attributable  to  the  difference  In  the  way  maximum 
error  at  impact  is  computed. 


A more  interesting  example  Is  the  control  problem  in  the  plane  with  no 
autopilot  dynamics.  Let 


( 


* k 


(D-89) 


the  control  Is  exercised  through  the  acceleration  A.  It  will  be  assumed 
that  A/V  is  small  in  magnitude  and  that  X and  Z are  both  monotone  in- 
creasing (See  Figure  D-4) 
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The  problem  Is  perhaps  more  easily  studied  in  a rotated  coordinate  sys- 
tem. Let  Tr  be  a rotation  in  the  plane;  i.e., 


/ cose  sine \ 

T11  ‘ \-sin;  cos;/ 


(D-90) 


where;  is  the  angle  of  rotation.  Clearly 
Oet  |tr j . 1 s V1  - y 


Further  if  ; is  a differentiable  function  of  time,  then 


(-sin;  cos; 

-cos;  -sin; 
0 0 


; 

o 

o 


o 

o 

0 


CD-91) 


(D-92) 


Let  be  the  nominal  trajectory  in  the  new  coordinate  system;  i.e., 


x 


nT 


Vn 


( D-9  3 ) 
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Then 

xnT  ■ Vn  * TR»n 

■ Vr  lxnT  * TRf(TR  l>tnT*  (D'94) 

■ VxnT*  un> 

From  (0-92)  and  (0-94) 


T-1x 


nT 


'nTl 


COSY  - 


xnTisi"Y  + 
A/V 


/V  cosy\ 
f(T“1xnT,  u)  • ( V slny  J 
\ A/V  / 


/ ^2xnT  + V cos 

fT  “ I “hxnT  ” V s1n 
\ A/V 


(D-9Sa) 


(D-95b) 


(0-96) 


Equation  ( D-96 ) gives  the  dynamics  In  the  new  coordinate  system.  If 
5 ™ 0,  then  fT  ■ f.  If C ■ 90,  then  x^j  ■ Z.  By  selecting  the  correct 
rotation  variable,  one  Is  able  to  choose  either  of  the  original  posi- 
tion variables  in  (0-89)  as  the  Independent  variable  for  the  problem. 
Furthermore,  time  variable  choices  for  C permit  still  more  flexibility. 
Unfortunately,  analysis  of  (0-96)  Is  fairly  difficult.  To  gain  Insight 
Into  the  properties  of  the  system,  some  Interesting  special  cases  will 
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be  investigated. 


Suppose  that  c ■ 0.  Using  the  first  component  of  as  the 
variable  yields. 


f 


r 


From  (0-97),  Fr  and  Gr  are  easily  derived. 


F 


r 


G 


r 


0 0 0 
0 0 sec2y 

0 0 AV'2  tany  secyj 

0 

0 

V"2  secy 

m m 


Suppose  the  nominal  values  for  A and  V are  nearly  constant, 
becomes 


M 


0 ' 


0 

0 

.2 

V secy 


0 

to  * 

0 

V'2  sec3y 

-4  2 

AV  tany  sec  y 

- 

0 

yV  tany  secy 

m m 

0 

V"2  sec3y 

AV'3  tany  secy  (V"*  secy  -1) 


independent 


(D-97) 


Then  (D-19) 


(D-99) 
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and 


0 


0 


V’2  sec3y 


V"2  secy 


AV"3  tany  secy  (V1  secy  -1) 


if  c 


Clearly  states  2 and  3 are  controllable  while  state  1 Is  not. 
Suppose  next  that  C ■ 90.  From  (D-96) 


V slny1* 


1 


fT  ■ ( -V  COSY  1 . f ■[  -COtY 


AV 


-1 


y.AV  CSCY, 


Consequently, 


[•'  . 

• 

0 

0 

• 

0 

0 

? 

F ■ 

rr 

0 

0 

-CSC2Y 

•.  Qr  ■ . 

0 

0 

m 

0 

■AV-2  COtY  CSCY 

« 

V"2  CSCy^ 

As  before 
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0 

V‘2  CSCY 


1 

0 

m m 

0 

i 
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-V'2  CSC3Y 

-4  2 

-AV  COtY  CSC  Y 
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and 


0 

0 


-V2  csc3y 


V"2  cscy  -AV'3  coty  cscy  (V’1  cscy  -1) 


If  ; 3 90 


The  first  two  transformations  are  of  obvious  Interest.  Let  us  turn  now 
to  some  time  variable  relations.  Suppose  thatC»Y  . Prom  ( 0-96) 


fr  * 


’*nTl(ltnT2  “ A 

A-Vr1 


(D-103) 


Let 


lu2 


xnT2+  A V 


Then 

i£L  . .d* 2 ; lAli  - vVV2 

3xnT2  3A 


Consequently 


Fr  " 

’ o o' 

-1  .-2 
•*  »nT>&  0 

; Gr  • 

■ — 

0 

-A'2w"! 

. 0 "A"2  0 . 

. vW2  . 

(0-104) 
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where  Q is  2 x 2.  From  (D-105) 
det  Q2  • V4 A'V4  xnJ1 


V3A’3A"3 


(D- 106) 


From  tfyls  we  see  that  states  2 and  3 are  controllable,  but  only  barely  so. 
If  the  nominal  trajectory  were  constant  (xnT2  * 0)  Q2  would  have  rank  1. 

As  a final  example,  consider  the  rotation 

w 

C ■ tan’1  ~ CD-107) 

*nl 

The  angle  1;  singly  the  look  angle  toward  the  target. 

From  (D-90)  and  (D-93)  we  observe  that  (see  Figure  D-4) 


snTi*  xnS°‘;  * x"i1nt  «n2  (0-108) 

xnT2-  “ xn{1n;  + *n£osc  : 0 (D-109) 

From  (D-109)  and  ( 0-96 ) It  then  follows  that 

£ . . 1 liiuLLzJd.  (D-iio) 

xnTl 

jC 

xnTl"  V^cos  ^ " *)  ‘ x s1n  * y}>  (D-Ul) 
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Thus 


1 
0 

-1,-1 


lAV 


(0-112) 
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0 

0 

-1  3d 

3 X 


-1 


nTl 


0 

0 

V’V1 


AV 


0 

0 

• 1 3d 


-1 


3x 


nT2 


AV 


0 

0 

-1  3d 


-1 


3Y  J 
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Direct  substitution  yields 

’ 0 0 " 

0 0 

Q31  Q32 


(D-114) 


The  system  given  by  (D-113)  has  only  one  controllable  direction. 


The  loss  of  controllability  evidenced  by  (0-114)  Is  due  to  the  fact  that 
one  position  component  Is  always  zero  In  the  rotated  coordinate  system. 
Only  range  and  flight  path  angle  are  measured  and  these  variables  are  not 
enough  to  control  the  system.  Suppose  we  augment  the  state  by  Including 
; as  a state  variable.  Since  x^  ■ 0,  we  find  that 


xnTl«  V cos  (;  - y) 

i ■ sin  (;  - y) 

xnTl 


(D-115) 


Y 


A 

V 
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If  we  use  x T,  as  an  independent  variable 
n 1 1 


fr-  ( - x„T1tan  ( e-r) 


i AV’^sec  ( S - y) 


(D-116) 


Direct  calculation  yields 

0 


Fr' 


G - 

r 


xnTl  tan^"Y) 


0 

0 

V*2 sec(C-Y) 


0 

.xnn'l»«2(‘:-v) 


*x„t1-W(c-y) 


AV“2tan(;-Y)sec(c-Y)  AV"2tan(;-Y)$ec(;-Y) 


(D-117) 


From  this  we  see  that 

0 
i 

M, 


V“2sec(;-Y) 


(D-118) 


v"2xnTi“lsec3(!:-Y) 
AV‘4tan(;-Y)sec2(c-Y) 


K 


If  or  is  small,  (Fr,  Gf)  is  controllable  in  the  two  coordinates ; and  Y 
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0-2.6  Selection  of  the  Independent  Variable 

In  the  previous  selections  the  use  of  a state  variable  as  the  independent 
variable  is  shown  to  ameliorate  the  undesired  characteristics  of  the  time 
based  controller.  The  analysis  thus  far  has  not  addressed' the  issue  of 
selecting  the  Independent  variable  when  in  fact  several  candidates  possess 
the  requisite  properties.  In  this  section  a means  of  performing  the 
selection  Is  of  Interest. 

Restricting  attention  to  the  class  of  transformations  given  by  (D-90)  and 
to  those  values  of f for  which 

xpl(t)  ■ (Tt<  c ) xpl ) x Is  monotone 
and 


dx  ( t) 

3>£TT)  ' VVup!{> 

Corresponding  to  a specific  value  of  f there  is  a dynamic  equation  of  the 
re-entry  vehicle,  Equation  0-119.  To  synthesize  the  best  regulator,  the 
analyst  must  select  a permissible  value  of  fin  such  a way  as  to  make  the 
closed-loop  system  perform  In  the  best  possible  way.  Observe  that  dif- 
ferent system  representations  are  being  compared  and  a germane  "docility" 
Index  which  would  expedite  this  comparison  would  be  useful. 

Before  defining  a docility  Index  for  this  system,  a few  observations  are 
apropos.  Consider  the  nonlinear  system  of  Equation  (D-3)  with  Its  per- 
turbation equation  characterized  by  the  £f,  Gj  matrix  of  Equation  0-7. 

If  the  perturbation  equation  Is  controllable  at  time  t^,  It  Is  well  known 
that  any  observed  error  x(tj)  can  be  eliminated  at  time  t ^ >tj  with 
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minimum  expenditure  of  control  energy  E given  by  (See  Reference  0-6)* 


E(x( t^ ) * t ^ , tg ) 


/2 

u2(r)dr 

C1 

(t2  - t1)"1x* (tj)  W"l(t1.  t2)x(t1) 


(0-120) 


where 


rh 

W(tj,  t2)  ■ J •(tj,  r)G(  r)6'(  r)  (tj,  r)dr 


(D-121) 


And  * i s the  transition  matrix  associated  with  F,  Let  { \ ^ (t^t,)  } be  the 
positive  eigenvalues  of  W arrayed  In  decendlng  order  and  let  { t2)} 
be  the  associated  set  of  eigenvectors  ordered  In  conformity  with 
{ \ ^tj.  t2)  } . Let 


n j * 11m  n^tj,  t2) 

trti 


(D-122) 


Recall  the  definition  of  the  controllability  matrix  C„  as 

n 

Cn  “ [V  Ml’  ’ ‘ 1 ’ Mn-l] 


Mq  • G (0-123) 

Vi " *FMk  A- k"1*  ■ • • 

T to  call  I as  defined  by  Equation  D- 120  the  control  energy  is  something 
of  a misnomer  In  so  far  as  the  (t2  - tj)"*  factor  gives  E units  more 
akin  to  power.  Still,  In  this  application  It  Is  useful  to  think  of  E 
as  an  energy  figure  with  an  Implicit  normalization  with  respect  to  the 
time  increment, 
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The  system  (F,  G)  Is  completely  controllable  if  the  rank  of  Cn  is  n.  In 
this  circumstance  W (see  0-121)  is  positive  and  the  minimum  energy  trans- 
fer from  any  Initial  state  to  the  origin  in  the  interval  [ t ^ , tg 3 is  that 
given  by  Equation  (D-120)  (See  Reference  D-6) 


It  was  shown  in  Reference  D-7  that  W can  be  expressed  as  the  sum 


W(t 


o’ 


tl) 


£ 

1 id’ 


/* 

,1,V  ■ , ^(t  )M/(t  ) (D-124) 

jim+rr  1 0 J 0 


If  x is  a unit  eigenvector  of  W(t  , t.)  with  associated  eigenvalueX  , 

0 0 1 4 

then  the  energy  required  to  drive  xQ  to  the  origin  is  \ . 


Suppose  (t1  - tfl)  is  small.  In  the  system  of  Interest  u is  scalar  and 
are  column  vectors.  Retaining  only  third  order  terms 


W(t 


o’ 


V 


<‘l  - VW 


<‘l  ■ ».>■ 


<W 


(0-125) 

+ o (t1  - tQ)3 


The  eigenvectors  { n^(tQ,  t^)  > of  the  positive  matrix  W span  Rn  and  can  be 
found  from  the  algorithm 


n i 'Wn  ■ max  n 1 Wn  ; n'n  »l 
1 1 n 


• u 

n,  ’i,  ■ max 
c * n 


In  n 
n'n 


1 

- 0 
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Let  the  associated  eigenvalues  be  labeled  X ^ , x ^ * • • • From  Equation 
(D-125)  it  is  clear  that  for  small  (t^  - tQ) 

ni » m0ii M0ii \ • it,  - giiNji2 

(0-126) 

E(  n j.  dt)  - ||Mo||  _2dt“2 

The  energy  associated  with  the  next  eigenvector  rig  can  be  similarly 
computed 


E(  n2,  -dt)  - i ( n2'M1M1'  n2)_1dt"4 


( D-127) 


Where  C Is  a normalization  constant. 

This  procedure  can  be  continued,  but  Equations  (D-126)  and  (D-127)  will 
suffice  for  this  problem.  The  directions  and  r2  can  be  thought  of  as 
"easy"  and  "hard"  directions  to  control,  respectively.  Since  M ■ G,  the 
fact  thatr1  * CMQ  simply  expresses  the  fact  that  the  first  order  In- 
fluence of  u Is  In  the  direction  G.  It  Is  more  difficult  to  cause  the 
system  to  move  in  then^  direction  as  evidenced  by  the  fact  that  E 
( n2,  dt)  is  proportional  to  dt"4.  The  energy  figure  for  this  latter 
direction  depends  upon  FG  as  well  as  the  time  variation  of  G. 


The  problem  of  using  these  energy  figures  to  compare  different  indepen- 
dent variables  Is  made  difficult  by  structural  degeneracies  In  the 
(Fr,  Gr)  system  (see  D-66).  Indeed,  since  xr^  » 0,  (Fr,  Gp)  can  not  be 
controllable  In  the  usual  sense.  Consider  the  system  described  by 
(D-66).  Mimicking  the  development  leading  to  (D-123),  (Fr,  Gr)  will  be 
said  to  be  controllable  if  rank  C„  , * n-1; 
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“n-1 


V1 


The  controllability  subspace  would  be  all  xr  orthogonal  to  (1,  0, 

The  energy  content  In  the  directions  n^and  ng  In  the  (xr,  ur)  coordinate 
system  follow  directly  from  (D-126)  and  (D-127) 


E<V  d«p,(5)  ) - l|M0||  ||n1  ||Z|dxpl{  e )|-£  (0-128) 

{rin'M.M.'ttJ"1  ,,  ,.d 

E(v  %i(0  ) ■-TTiVTiit—  l|n2H  ldxPlu)l 


From  (0-120)  and  (0-129)  the  energy  content  Is  the  product  of  three 
types  of  factors.  The  first  factor  Is  the  energy  associated  with  a unit 
perturbation  In  the  direction.  The  second  factor ||n ||  scales  the 
error  with  respect  to  the  actual  perturbation  expected  in  the  Indicated 
direction.  The  final  factor  scales  the  energy  with  respect  to  the  In- 
crement In  the  Independent  variable. 

As  written,  (0-128)  and  (D-129)  are  not  In  a form  which  facilitates  com- 
panion of  different  values  of  C . Each  of  the  factors  in  these  equations 
depends  on  5 and  simple  scale  changes  In  x ^ are  translated  Into  apparent 
changes  In  energy  content,  To  form  a valid  basis  for  comparison,  (0-128) 
and  (D-129)  must  be  expressed  as  a function  of  the  same  error  In  the  time 
domain.  From  (D-3)  It  Is  clear  that 

dxpiU)  • (Tr(  C )f(xp,up))1dt  (D-130) 

(D-130)  provides  the  factor  required  to  normalize  the  time  interval  over 
which  control  Is  accomplished. 
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The  normal izatlon  of  the  eigenvectors  is  somewhat  more  subtle.  A 
given  Initial  error  In  the  x coordinate  system  Is  transformed  Into  a 
different  apparent  error  In  the  xr  (C)-plane.  Suppose  there  Is  an 
Initial  error  x in  the  xn  -plane.  This  error  becomes  x(  C ) under  the 


transformation  TR(  C ) ; 


xU  ) • T0U  )x 


It  was  shown  in  Reference  0-8  that  the  perceived  error  when  x^(  c ) Is 
used  as  the  variable  of  evolution  Is 


\(  O * Tr(xpl(  A))Tr(  Ox 


(0-131) 


where 


0 0 


,fr2 


>3 


(D-  132) 


An  Initial  error  x gives  rise  to  an  Indicated  error  x)t(  c ) of  the  follow- 
ing form 


n-l 

"i’W 

7u,iTr~" 1,1 

1-1  1 


(0-133) 


The  coefficients  of  the  decomposition  of  the  error  vector  given  above 
measure  the  relative  size  of  sensed  errors  In  the  different  coordinate 


I 


IMii’ 


■ ■ -•x.-  .y  • 


A 
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systems.  In  the  problem  under  study  here  x Is  not  known  a priori  and 
will  be  considered  to  be  a random  variable.  In  this  case  the  relative 
sizes  of  the  Initial  errors  In  the  xr  coordinate  system  will  be 

M Hi 11  •llB1,Tr(xplU))TR(C)x||;  1-1,  ,,,  n-1  (D-134) 

where  8^  Is  a unit  vector  In  the  direction. 

Combining  Equations  (0-128),  (0-129),  (0-130)  and  (D-134) 

E(V  dxpl>  " [‘V)1]'2|l4l'TrTRx||2<lt'2 

L * (0-135) 

E(n2idxpi)  • \ ( ftjj'MjMj'fig)"1  [(TRf)j  J “4||e2TrTRxl|  2dt“4 

e 

• 

For  convenience  let  E(n^;dxpl)  ■ dt“2^+2  where  Is  defined  above. 

With  the  energy  content  of  errors  in  the  directions  given  by  (0-135), 
a scalar  valued  measure  of  system  docility  would  be  a useful  Intermediary 
for  comparing  the  relative  merits  of  different  values  of  C.  Obviously  If 
there  existed  a value  of  C say  C*  which  minimized  ot^  uniformly; 

a4(C'*)  s min  a,(  C );  1-1,  ....  n-1 
1 C 1 

thenC*would  yield  the  best  possible  choice  for  xpi(C).  Unfortunately, 
a uniformly  best  value  of  twill  seldom  exist,  and  the  analyst  must  be 
content  with  something  less. 

The  docility  Index  found  most  suitable  for  this  class  of  problem  is  given 
by  H; 
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(D-136) 


n-1 

h(  c ) ■ e { n 


where  E j [denotes  mathematical  expectation.  That  value  ofCwhich  min- 
imizes H ( ; ) Is  said  to  be  locally  best  choice  of  ?-, 

H(C*)  ■ Inf  H (?)  (D-137) 

C 

Since  a.  cannot  be  made  uniformly  small  by  selection  of  ?,  the  expecta- 
tion of  the  product  of  the  a's  Is  made  small.  Note  that  for  ? ■ ?0 
the  controllability  subspace  of  (Fr,  Gr)  Is  of  dimension  less  than  n-1, 
and  M (?  ■ ?Q)  « «.  It  Is  Interesting  to  note  that  H (?)  bears  close 
kinship  with  measures  of  controllability  proposed  In  Keterences  l)-y  and 
0-10  which  use  det  W“*  to  Induce  a controllability  ordering  on  the  set  of 
admissible  conrollers.  Of  course,  the  normalizations  involved  in  deriv- 
ing (0-136)  makes  the  final  criterion  somewhat  different. 

It  has  been  shown  above  that  If  lt2  - tj|  Is  small  and  u Is  scalar  valued, 


E(n.j}  tj,  tg) 
1*1,  ...  n 


a1  I *2  " *1^  higher  order  terms; 

(D-137) 


The  equations  for  the  Individual  are  given  in  the  Appendix  (see  D-135). 

(D-137)  Indicates  that  there  is  a natural  decomposition  of  the  state 
space  Into  a set  of  orthogonal  directions  characterized  by  the  difficulty 
with  which  Initial  errors  along  each  of  the  directions  can  be  eliminated. 
For  example  an  error  In  the  'easy'  direction,  n, • can  be  eradicated  by  an 
actuating  signal  expending  energy  proportional  to  I t2  - t^|  . Observe 

that  as  the  time  Interval)- over  which  control  Is  accomplished  decreases, 
the  amplitude  of  the  actuating  signal  Is  increased.  The  asymptotic 
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behavior  of  E represents  the  confluence  of  these  antithetical  limits. 

In  (D-137)  the  time  factor  |t2  ■ t^|  is  a fixed  scaling*  but  the  set 
jdj}  gives  a local  Indication  of  the  systems  ability  to  steer  out  errors. 
Because  only  local  energy  figures  have  been  derived,  the  relative  merits 
of  different  systems  would  be  expected  to  vary  with  time.  The  way  In 
which  these  sets  are  used  to  form  a performance  index  depends  upon  the 
specific  objective  envisioned  for  the  vehicle.  An  example  of  such  an 
index  Is  given  In  the  following  section. 

Different  independent  variables,  or  equivalently  different  choices  of  c, 
give  rise  to  different  behavioral  characteristics  for  the  vehicle  in  the 
coordinate  system  associated  with  the  regulator.  To  put  the  problem  of 
selecting  the  best  value  of  Con  a rational  basis,  some  criterion  of 
choice  Is  required.  In  the  Appendix,  one  such  criterion  1$  discussed. 

In  lieu  of  trying  to  minimize  the  Individual  values  of  the  In  (D-137) 
a function  H Is  defined  as  follows:* 

n-1 

H(  5 ) - U o^C  ) (D-138) 

1-1 


This  function  orders  the  set  of  permissible  Independent  variables.  The 
value  ofCls  sought  which  minimizes  H; 

H(C*)  • inf  h (;  ) (D- 139) 

C 


*As  Indicated  earlier  E{nc^(C  )}  Is  used  when  x(t^)  is  random. 
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Note  the  la  } are  coefficients  which  characterize  the  energy  content  of  a 
class  of  errors  In  (n-1)  orthogonal  directions.  In  the  unlikely  event 
that  there  Is  a value  of  5 which  minimizes  these  energy  coefficients  un- 
iformly, this  value  of C would  be  that  Indicated  by  (D-139).  A more  typ- 
ical situation  would  be  one  In  which  Improvement  in  performance  In  one 
direction  carries  with  It  a concomitant  degradation  In  performance  In  one 
or  more  of  the  other  directions.  The  Index  H provides  an  ordering  of 
possible  Independent  variables  In  this  more  common  circumstance  satisfying 
some  but  not  all  of  the  deslrata  used  by  Muller  and  Weber  In  Reference  0-9 
to  delineate  a measure  of  the  quality  of  controllability. 

To  Illustrate  these  notions  consider  the  dynamics  model  of  a re-entry 
vehicle  whose  primary  motion  Is  confined  to  the  X-Z  plane  as  In  (D-89). 
Observe  that  (D-89)  Is  a very  simple  representation  of  the  actual  equa- 
tion of  motion  for  the  vehicle.  Neglected  are  the  nonllnearltles,  sam- 
plers, autopilot  dynamics,  and  exogenous  Influences  which  affect  actual 
vehicle  motion.  The  simplification  Implicit  In  (D-89)  is  Intentional 
since  one  of  the  objectives  of  this  study  Is  to  determine  the  degree  to 
which  simple  analysis  models  can  be  used  to  derive  controllers  for  a com- 
plicated dynamic  system. 

The  class  of  transformations  of  Interest  in  this  study  are  fixed  rotations 
In  the  X-Z  plane;  1 .e.  t sO, 


Direct  calculation  leads  to  the  conclusion  that 


xp  (C  ) 


(Vcos(Y-;) 
Vsln(Y-S) 

AV’2 


tan(Y-C0) 
AV“2sec(Y-C0); 


(D-140) 


where  It  has  been  assumed  that  Xp  Is  such  that  xp^  (C  ) Is  monotone, 
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To  findjoi^}  . the  system  controllability  matrix  must  first  be  found.  This 
matrix  is  given  in  (0-123). 

C2  ■ <Mc*Mi> 

where  (see  Equation  (A-4)) 


C D- 142 ) requires  careful  interpretation.  The  controllable  subspace  of 
the  perturbation  equation  associated  with  (0-140)  can  be  decomposed  into 
an  "easy"  direction,  n,.  and  a "hard"  direction  n*,.  From  D-89  it  is 
evident  that  the  easy  direction  is  associated  with  an  angular  error  and 
the  hard  direction  with  a position  error.  This  result  is  Intuitively 
appealing  since  the  acceleration  acts  directly  on  Y and  only  Indirectly 
on  position  errors. 

To  compute  the  docility  Index  given  by  Equation  0-138  using  the  result 
given  In  (13-135)  only  the  appropriate  amplitude  normalization  Is  yet  to 
be  determined.  (D-131)  provides  an  equation  relating  the  time  based 
error,  x, and  the  error  perceived  by  the  controller  x (0.  Substituting 
the  required  quantities  into  this  equation 

( 0 0 0\ 

-sinYsec(Y-v)  cosYsec(>-;)  Ojx(D-14J) 

-AV'^coscsectY-O  -AV*‘‘’sin;sec(Y-t)  1/ 
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[n  the  application  of  Interest,  the  primary  initial  errors  are  In  posi- 
tion since  the  angular  orientation  of  the  vehicle  Is  controlled  quite 
accurately  during  boost  and  freeflight.  Suppose,  therefore,  that  the 
Initial  error  in  the  (xn,  un)  coordinate  system  Is  given  by 

©/COSX\ 

- (slnxl  (0-144) 

\ 0 / 

The  parameter  X gives  the  direction  of  the  initial  error  and  the  size  of 
this  error  has  been  normalized.  The  perceived  error  resulting  Is 


xr(C) 


/ 

I sec(Y-C)sln(X«Y) 

' AV*zsec(Y-0  cos(X-c) 


(0-145) 


.1 


Assume  that  the  Initial  error  angle  X is  uniformly  distributed  on  [0,  2 it] 
and  Is  Independent  of  Y.  From  (D-134) 

llhjll-  l AV“ 1 sec  (Y-C)  cos  (X-c)| 

(0-146) 


lln2ll-  I sec  (Y-C)  sin  (X-Ol 

Substituting  these  values  Into  the  defining  equation  for  H 
2 *2 

H(0  - * -j^-  Cl  ♦ 2 Sln2(y-0J  sec2(Y-0  (D-147) 


From  D-147  It  follows  that  the  best  choice  of  Cat  time  t^  would  be 
C-Y(tj) 


H(C-Y(tl)) 


min  H (C) 
C 


(D-148)  1 
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From  ( D - 1 4 8 ) it  is  clear  that  the  locally  best  coordinate  system  in  which 
to  control  the  vehicle  is  one  in  which  the  instrantaneous  position  is  ex- 
pressed in  the  rotated  coordinate  system  shown  in  Figure  D-5.  The  in- 
dependent variable  xpjU*)  can  be  thought  of  a range  variable  and  the 
component  of  state  in  which  error  can  be  measured  can  be  thought  of  as 
a pseudo-miss  variable.  Although  (D-148)  would  appear  to  suggest  that 
good  performance  could  be  attained  by  setting  C(t)  ■ Y(t),  time  variable 
rotation  is  not  permitted  by  the  hypotheses  which  lead  to  (D-148).  The 
rotation  angle  must  be  constant  throughout  the  trajectory  and  as  a con- 
sequence a Judicious  choice  ford  would  be  that  which  approximates  most 
closely  the  realised  value  of  Y for  that  portion  of  the  trajectory  of 
primary  concern.  On  a mission  in  which  terminal  miss  Is  a prime  per- 
formance contributor,  ;■ Yn  (t^)  would  appear  to  be  a rational  choice. 

0-2 . 7 An  Example 

To  explore  soma  of  the  nuances  of  the  synthesis  procedure  presented  in 
the  foregoing  sections,  a simulation  study  was  performed  to  test  some 
of  the  guidance  laws  described  above  on  a sophisticated  and  relatively 
complete  simulation  model  of  a particular  aerodynamical ly  controlled  re- 
entry vehicle.  There  were  a number  of  questions  to  which  this  study  gave 
at  least  partial  answer.  Of  most  concern  were  the  relative  merits  of  a 
time  based  guidance  law  and  one  which  used  a trajectory  variable  as  the 
variable  of  evolution.  Secondly,  the  correspondence  of  the  docility 
index  given  by  (D-137)  and  the  observed  behavioral  qualities  of  the  guid- 
ance law  were  of  interest.  Finally,  the  general  question  of  the  utility 
of  the  analysis  model,  (D-89),  In  constructing  guidance  laws  was  also 
under  investigation.  There  are  four  guidance  laws  whose  behavior  has 
been  studied  in  some  detail.  They  aro; 

Ut:  time  is  the  Independent  variable 

U^:  downrange  position  is  the  Independent  variable  (C*  0) 
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altitude  is  the  independent  variable  (w*tt/2) 


U*:  C»Yn(tf) 

i 

The  regulators  and  U2  are  of  Interest  because  of  their  implementations! 
simplicity.  In  both  cases  a directly  measured  trajectory  variable  Is 
used  as  the  Independent  variable.  On  the  other  hand,  the  Independent 
variable  associated  with  U*  must  be  computed  from  measured  quantities. 
Still  U*  Is  of  significant  Interest  because  It  locally  minimizes  H at 
the  termination  of  the  trajectory.  The  regulator  Ut  Is  explicitly  time 
dependent  and  Its  performance  forms  a base  of  comparison  for  the  other 
regulators . 

The  weighting  matrices  In  the  performance  indices  for  the  regulators 
were  selected  to  penalize  each  of  the  regulators  similarly  for  similar 
errors.  First  consider  (P,  Q,  R)  In  (D-U).  The  weighting  on  control 
was  constant  and  was  essentially  given  by 

(D-149) 

wheredA|)Wx  is  the  maximum  permissible  magnitude  of  variation  of  accelera- 
tion from  Its  nominal  value.  The  state  error  weighting  took  the  form 

Q(t)  - d1*9(q12(t).q22(t)  .q32U))  ( D- ISO ) 

The  state  weights  were  , 

q,2(t)  • 4 (0-151) 

1 (Ax  *) 

' l 'max 

where  the  allowable  position  error  decreased  monotonlcally  from  the 
a 

order  of  10  feet  at  re-entry  to  the  order  of  10  feet  at  impact.  The 


max 
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allowable  angular  deviation  was  also  time  variable  but  was  monotonical  ly 
increasing.  The  terminal  position  weight,  P,  Is  given  by 


P - Q(tf) 


(D-152) 


The  weighting  matrices  for  U^,  U^,  and  U*  were  defined  similarly.  In 
each  case  the  associated  Q was  diagonal.  Because  of  the  degeneracy  of 
the  state  space,  q^  Is  Irrelevant  and  the  complete  position  error  Is 
weighted  by  q2-  For  this  reason 


where  q^  Is  given  by  (0-151)  and  the  first  factor  In  Q?  is  time  normal Ixa 
tlon,  the  other  performance  weights  are 


PC  " tVxpl^tflC^ 


(D-154) 


(D-153)  makes  the  position  and  angular  error  weights  in  the  xr(0  coordi- 
nate system  compatible  with  those  used  in  deriving  IL.  Note  that  U , U, 

L 4 

and  U*  measure  position  error  as  a scalar  while  Ufc  senses  a two  dimen- 
sional position  error.  The  weighting  matrices  given  by  (D-149)  through 
(D-154)  provide  like  weights  to  like  errors  and  the  influence  on  perfor- 
mance due  to  time  scale  distortion  Is  avoided  by  the  "velocity"  factor  in 
(D-153)  and  (D-154). 

To  relate  the  docility  Index  given  in  (D-138)  to  actual  vehicle  perfor- 
mance, a simulation  study  was  undertaken.  The  vehicle  simulation  equa- 
tions provided  a detailed  description  of  the  dynamic  structure  of  an 
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actual  re-entry  vehicle.  This  comprehensive  model  actually  provided  an 
Impediment  to  good  performance  for  the  regulators  designed  here  because 
these  regulators  are  based  upon  a dynamic  hypothesis  that  Is  deficient 
In  many  respects.  Of  the  simulation  results  obtained,  those  from  three 
numerical  experiments  are  presented  here.  In  each  case  the  nominal 
trajectory  began  with 

X(tQ)  » order  105  feet 

Z(tQ)  • order  105  feet 

t * 0;  tf  • order  10  seconds 

Y(t0)e[G,ir/4);  Y(tf)c  (tr/4,  nr/2] 

The  three  tests  are  described  as  follows: 

1)  Xp(tQ)  • *nU0)  " “ oirc*er  103  f«*et,  x ^ ( tQ ) ■ 0 otherwise 

2)  Z (tQ)  - Zn(tQ)  ■ - order  of  103  feet,  x^(tQ)  ■ 0 otherwise 

3)  No  Initial  error,  0.9  times  nominal  air  density  on 

[0,  tf/2]  , 1.1  times  nominal  air  density  on  (t^/2,  tf]. 

Figure  0-6  shows  the  result  of  the  first  test.  For  an  Initial  X perbur- 
batlon  the  perpendicular  path  errors  are  plotted  on  a log  scale.  The 
error  magnitudes  have  been  normalized,  and  while  the  relative  errors  of 
the  regulators  are  accurate,  their  absolute  values  have  no  significance. 
All  three  time  Independent  controllers  behave  in  the  way  one  would  expect. 
All  begin  with  the  same  trajectory  error  arid  In  each  case  the  error  builds 
up  slightly  because  of  autopilot  effects.  Because 

l>n(to)l<|Yn(to)  ‘Yn(tf,l<|Yn(to5  _tt/21  (D'155) 
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Trajectory  Errors  for  an  Initial  X Error 
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on  the  trajectory  of  interest,  one  would  expect  from  (0-147)  that  the 
preference  ordering  of  the  regulators  would  Initially  be  U first,  IL 
second  and  third.  This  is  Indeed  the  case  as  shown  in  Figure  D-6. 

For  that  part  of  the  trajectory  satisfying  (D-155)  the  docility  index 
provides  an  ordering  In  accord  with  the  trajectory  following  fidelity 
of  the  associated  regulator.  Although  the  initial  portion  of  the  trajec- 
tory is  subject  to  aberrant  drag  forces  and  acceleration  limits,  the 
slowly  varying  control  gains  tend  to  reduce  sampler  and  autopilot  effects. 
The  dynamic  equation  given  by  (D-89)  is  a fully  adequate  regulator  syn- 
thesis model  for  90*  of  the  trajectory.  The  comparison  of  the  time  in- 
dependent controllers  at  termination  is  obscured  by  autopilot  influences. 
Near  the  end  of  the  trajectory,  the  regulator  gains  are  rapidly  varying, 
and  the  autopilot  has  difficulty  in  providing  a faithful  reproduction  of 
the  required  actuating  signal.  Even  here  (see  Table  0-2)  the  comparison 
of  and  U*  with  Ux  is  that  predicted  on  the  basis  of  Equation  (D-147). 
The  former  regulators  have  Impact  errors  that  are  within  the  best  accur- 
acy to  be  expected  while  Ux  has  a somewhat  larger  error. 


The  performance  of  Ut  as  given  in  Figure  0-6  and  Table  0-2  appears  super- 
ficially to  be  Incorruct,  Far  from  causing  a diminution  of  the  Initial 
error,  Ut  causes  the  trajectory  following  error  to  increase  by  an  order 
of  magnitude.  The  error  of  impact  is  inferior  to  that  obtainable  with 
no  feedback  regulator  at  all.  Another  way  of  comparing  Ut  with  the  set 
of  Ur  is  In  terms  of  the  amount  of  control  used  on  the  trajectory.  In  a 
guidance  system  using  a performance  Index  like  (D-ll),  the  regulator 
seeks  to  use  as  little  control  force  as  possible  while  simultaneously 
maintaining  good  trajectory  following  qualities.  The  magnitude  function 
| R" JGKX 1 1 s a measure  of  the  degree  of  apprehension  with  which  the  regula- 
tor views  Its  Instantaneous  state.  Thus, 


“ f |R»rxr|dt 
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Table  D-2.  Guidance  Law  Performance 


Closocl-l oop 
Regulator 

Perturbations 

Performance  Deviations 

ADR 

Ft 

Error  in  Flight  Time 
‘1  of  Nominal 

/|u, |dr 

TT^lciT 

ut 

Initial  Downrange 

1672 

.031 

i 

Initial  Altitude 

3199 

.34 

l 

Density 

32b 

-.8  7 

i 

Ux 

-.11 

1.45  x 1U": 

-.69 

mmmm 

Density 

9.8 

-,7b 

WEMSBSm 

'U2 

I 

-.17 

9.3  x Uf J 

- Initial  Al  ti  tude 

H 

r . 7 (J 

8.9  x ID"'1 

Density 

b,U 

-.77 

5.7  x ur1 

Initial  Down ran  no 

2.0 

-.15 

-Uu.La.io".: 

5.1  x 10* J 

Initial  AltUudo 

2.9 

- .6  4 

Density 

4.8 

-.77 

5.9  x ID*1' 
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Is  a measure  of  disapprobation  for  the  closed-loop  vehicle  trajectory. 
Defining  *l*(C)1n  the  obvious  way,  ^ provides  an  Indication  of  how  control 
Intensive  each  of  the  regulators  Is.  The  actual  value  of  the  actuating 
signal  was  not  used  as  the  Integrand  In  (D-156)  because  saturation  In 
the  actuators  tends  to  desensitize  this  Index.  From  table  D-2  where 

the  relative  values  of^are  given,  the  regulator  IL  Is  seen  to  use  a 
2 ^ 
factor  of  10  more  control  than  Is  needed  by  the  time  Independent  con- 
trollers. The  excessive  use  of  acceleration  on  the  part  of  U„  Is  coupled 

to 

with  trajectory  following  performance  that  Is  approximately  10  worse 
than  that  attained  with  the  Uf  regulators. 

The  reason  for  the  conspicuous  Inferiority  of  Ut  lies  In  the  way  the 
trajectory  following  problem  Is  posed.  The  time  based  regulator  tries 
not  to  minimize  the  true  trajectory  error,  but  rather  moves  to  correct 
the  error  measured  by  x In  (0-5).  For  the  test  shown  In  Figure  D-6  the 
Initial  X error  was  such  as  to  Initiate  re-entry  at  a point  closer  to 
the  target  than  the  nominal  starting  point.  Because  the  controller  has 
no  way  of  slowing  the  vehicle  directly,  Ut  reacts  to  that  portion  of  the 
error  that  Is  Inherently  a time  translation  by  Increasing  the  path  length 
of  the  perturbed  trajectory.  Increasing  path  length  Is  control  energy 
Intensive  and  tends  to  cause  large  errors  normal  to  the  trajectory.  This 
"time-equivalent"  bubble  Is  characteristic  of  time  based  regulators  and 
Is  not  present  In  the  response  of  the  modified  LQ  regulators.  Table  D-2 
Indicates  that  Ut  Is  able  to  achieve  much  tighter  control  over  time 
of  flight  than  can  any  of  the  Ur<  Unfortunately,  this  attribute  Is  not 
of  any  particular  advantage  In  this  mission. 

Figure  D-7  shows  the  trajectory  bubble  for  an  Initial  Z error.  Only  the 
nominal  and  the  Ut  trajectory  are  shown.  The  time  Independent  controllers 
would  be  Indistinguishable  on  the  scale  of  this  drawing.  Figure  D-7  Is 
not  shown  to  exact  scale  but  Is  Indicative  of  qualitative  features 
shown  by  the  actual  vehicle  trajectories.  As  before,  a small  Initial 
error  Is  caused  to  grow  by  Ut  In  order  to  slow  the  effective  forward 
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velocity.  As  was  the  case  with  an  initial  X error,  Ut  overcompensates 
for  the  Initial  time  translation  and  has  a perturbed  flight  time  greater 
than  the  nominal  value.  This  timing  error  Is  presumably  due  to  controller 
saturation  near  Impact. 

The  Improvement  factors  associated  with  the  time  Independent  controllers 
are  repeated  In  this  example.  The  Impact  error  of  Ut  Is  orders  of  mag- 
nitude greater  than  that  accruing  to  the  alternative  regulators.  The 
Improvement  In  control  utilization  Is  again  on  the  order  of  100.  Although 
not  shown  In  Figure  0-7,  the  relative  performance  of  U^,  and  U*  was 
In  accordance  with  the  predicted  on  the  basis  of  the  docility  Index  H. 

The  previously  encountered  difficulty  with  near  Impact  manifests  Itself 
again.  The  excellent  performance  of  U.,  should  be  considered  to  be  more  a 
function  of  fortuitous  circumstance  than  design. 

The  final  example  provides  an  Interesting  assessment  of  the  robustness  of 
the  guidance  laws  studied  here.  In  this  simulation  there  was  no  Initial 
error,  but  the  dynamic  equation  of  the  vehicle  was  changed  by  decreasing 
air  density  by  10*  on  the  first  half  of  the  re-entry  trajectory  and  In- 
creasing It  by  10*  on  the  last  half.  Ideally,  the  regulator  output  should 
be  nearly  zero  since  there  are  only  slight  path  following  errors  created 
by  the  open-loop  portion  of  the  guidance  law.  The  three  time  Independent 
guidance  laws  do  follow  the  path  quite  closely,  albeit  at  a different 
rate  than  does  the  nominal.  The  related  errors  are  uniformly  less  than 
10  feet.  On  the  other  hand,  as  shown  in  Figure  D-8,  Ut  finds  the  density 
variation  particularly  bewildering.  In  the  low  density  portion  of  the 
flight  a large  error  builds  up  as  Ut  tries  to  slow  the  vehicle  by  In- 
creasing path  length.  When  the  sign  of  the  density  changes,  Ut  must  now 
Increase  Its  speed  along  the  nominal  path  starting  with  what  Is  now  a 
sizable  state  error.  It  does  this  In  part  by  crossing  over  the  nominal 
path  and  impacting  the  ground  short  of  the  target.  Because  of  this  ter- 
minal maneuver,  the  factor  by  which  Ut  deteriorates  performance  Is  loss 
than  that  found  In  some  of  the  earlier  tests. 
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One  peculiarity  of  the  path  flown  by  is  the  fact  that  the  time  of 
flight  differs  from  nominal  to  a greater  degree  than  do  the  other  regula- 
tors. This  may  be  due  to  the  disadvantageous  state  Into  which  Ufc  forces 
the  vehicle  midway  In  the  flight.  As  Table  D-2  shows,  U uses  excessive 
amounts  of  control  force.  As  before  U7  and  U*  are  clearly  superior  to 

v 

.1 

While  not  exhaustive,  this  simulation  study  Illustrates  some  of  the  be- 
havioral anomalies  of  Ut<  The  time  Independent  regulators  give  perfor- 
mance that  is  several  orders  of  magnitude  superior  to  that  attained  by 
Ut.  A comparison  of  Ux,  U2  and  U*  on  portions  of  the  trajectory  where 
the  neglected  vehicle  dynamics  had  the  least  Influence  suggests  that  the 
docility  Index  given  by  (D-147)  Is  suitable  In  this  application.  Further 
study  Is  necessary  to  resolve  certain  apparent  aberrations  In  relative 
performance. 

D-2. 8 Conclusion 


An  aerodynamical ly  controlled  re-entry  vehicle  has  dynamic  pecularltles 
which  tend  to  discourage  the  use  of  "linear-quadratic"  feedback  regulators 
In  guidance.  The  disadvantageous  features  of  the  vehicle  stem  largely 
from  Its  weak  controllability.  By  the  simple  artifice  of  using  a traj- 
ectory variable  In  place  of  time  as  the  independent  variable  of  evolulton, 
Important  deficiencies  of  the  IQ  regulator  are  avoided  and  a robust  guid- 
ance law  produced. 

The  selection  of  this  Independent  variable  from  the  available  alternatives 
Is  complicated  by  the  often  contradictory  exigencies  of  guidance  law 
simplicity  and  the  dynamic  response  of  the  vehicle.  Using  a simplified 
analysis  model,  this  report  provides  an  Index  of  quality  for  the  closed- 
loop  response  characteristics  of  the  vehicle.  This  Index  Is  phrased  In 
terms  of  the  local  energy  content  associated  with  perturbations  from  the 
nominal  trajectory.  In  terms  of  this  Index  It  Is  possible  to  rank  dlf- 


ferent  choices  for  an  Independent  variable. 


i. 

r 

i 


» 

t 

5 

* 


f 


Although  the  Index  was  selected  with  a view  toward  maintaining  a reason-  j 

able  level  of  analytical  tractablllty,  It  Is  still  true  that  the  form  of 
H precludes  the  development  of  a direct  algorithm  for  finding  the  best  j 

xpl>  Some  Intuitively  appealing  choices  for  an  Independent  variable  are  j 

fairly  easily  compared,  and  It  has  been  shown  that  the  "natural"  Indepen- 
dent variable  Z has  desirable  closed-loop  properties.  For  the  trajectory 
considered  here  either  11^  or  U*  would  be  adequate.  The  superiority  of 
these  regulators  to  the  classical  LQ  regulator  Is  readily  apparent 
both  In  the  fidelity  of  trajectory  following  and  In  the  judicious  use  of 
available  control  resources.  The  performance  of  the  time  based  regulator 
Is  so  poor  that  It  does  not  appear  to  be  a rational  candidate  for  this 
type  of  re-entry  mission. 
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SELECTION  OF  THE  INDEPENDENT  GUIDANCE  VARIABLE  THROUGH  A 
STATE  DEPENDENT  ROTATION 
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In  the  previous  section  the  use  of  a state  variable  for  the  Independent 
variable  of  the  controller  was  examined.  In  the  analysis  It  was  found 
that  the  transformation  from  a time  based  system  to  a system  based  on 
any  monotonic  state  variable  avoids  the  undesirable  performance  of  the 
time  based  system  and  a docility  Index  was  derived  which  provides  a 
basis  of  comparison  among  the  state  variables  In  order  that  one  might 
be  selected  over  the  others. 

The  docility  Index  and  simulation  results  Indicated  that  the  locally  best 
choice  for  the  angle  of  rotation  which  defines  the  Independent  variable 
Is  the  Instantaneous  flight  path  angle.  An  Important  restriction  on  the 
previous  appendix  Is  that  the  coordinate  system  In  which  the  regulator 
operated  was  time  Invariant.  This  leads  to  certain  ambiguities  In  the 
Interpretation  of.  the  docility  Index.  Because  local  docility  Is  being 
measured,  the  relative  advantages  of  different  Independent  variables 
tends  to  change  along  the  realized  trajectory. 

In  this  appendix  the  constraint  of  a time  Invariant  transformation  used  in 
defining  the  evolutionary  variable  Is  removed  and  Independent  variables 
depending  on  the  Instantaneous  state  of  the  vehicle  are  considered. 

D-3.1  Problem  Description 

In  this  section  attention  Is  restricted  to  the  class  of  systems  character- 
ized by  (0-119).  A rather  subtle  difficulty  emanates  from  a study  of  the 
Implications  of  (0-119).  Corresponding  to  different  choices  fort  there 
are  different  vehicle  descriptions  given  by  (D-119)  and  as  a consequence 
different  regulators  given  by  (0-68).  To  provide  a guidance  law  which 
yields  the  best  vehicle  performance  the  analyst  should  select  that  coord- 
inate system  (value  oft)  In  which  the  vehicle  is  most  amenable  to 
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control  (most  docile).  To  facilitate  comparison  of  different  choices 
of  C a scaler  valued,  local  docility  index  was  defined  in  Appendix  0-?. 
If  the  perturbation  model  [F(C),G(;)]  associated  with  (11)  Is  controll- 
able It  Is  well  known  that  a state  error  can  be  eliminated  In  the  "time" 
Interval  Cxpl(t^)  ^p^tg)]  with  minimum  expenditure  of  control  power  P 
given  by 


P(Xj,(Xp^(^^)  ,t^»t2)  ■ ( X-^( t2 ) “X_ t^)) 


Xpl(tl) 


U<Xpl)dXpl 


(D-157) 


It  was  further  shown  In  Section  D-2  that  If  (tg-t^l  Is  small,  there  Is  a 
natural  basis  for  the  system  state  space  of  the  perturbation  equation 
associated  with  (0-119)  {n^i  !■!,  ....  n-l|  such  that 


P(h^J  t^tg)  * I tg  “ t^| 


1 "1, . . . ,n-l 


(0-158) 


The  sequence  {oy.i"!, , . . ,n-l|  measures  the  energy  content  In  trajectory 
errors  In  different  directions  In  the  jjtate  space.  The  most  docile 
system  would  be  one  which  took  as  little  control  energy  to  control  as 
possible.  It  Is  usually  Impossible  to  uniformly  minimize  the  both 
because  of  their  complicated  dependence  on  c.  and  because  of  their 
dependence  on  xr(xp^(tj)).  Since  this  latter  quantity  Is  often  bast 
thought  of  as  being  random,  the  docility  Index  found  most  expedient  In 
Section  D-2  Is  given  by 

n-1 

H(S)  ■ Ej/70|(S)}  (0-159) 

1 -1 


The  locally  best  choice  of  ; Is  that  which  minimizes  H(C) 


H(C*)  - Inf  H(C) 


At  this  point  In  the  development  presented'  previously  certain  difficulties 
arose.  The  choice  of  ; rationalized  by  (0-160)  yields  that  transformation 
which  gives  the  locally  most  docile  system  equations.  Unfortunately  the 
locally  optimal  value  of  ; changes  as  the  vehicle  moves  along  Its  path. 

Since  ; was  Initially  constrained  to  be  a constant,  the  values  of  ; 
studied  were  chosen  with  the  value  of  ;*  In  (D-160)  used  only  as  a loose 
Indication  of  the  most  advantageous  choices  for  ;.  It  Is  the  Intent  of 
this  appendix  to  present  the  results  of  a study  In  which  the  performance  of 
regulator  derived  on  the  basis  of  continuously  using  the  "locally  optimal"  ■ 
coordinate  system  Is  explored.  This  Involves  some  substantial  changes  In 
the  evaluation  of  H since  the  "locally  optimal"  coordinate  system  Is  both 
time  variable  and  trajectory  dependent. 


D-3.2 


A Locally  Bast  Coordinate  System 


To  Illustrate  the  notions  described  above,  consider  the  simple  dynamic 
model  of  (0-89).  As  Is  the  case  In  appendix  0-2  the  class  of  transforma- 
tions of  Interest  In  this  study  are  rotations  In  the  X-Z  plane  given  by 
(D-90) . In  contrast,  however,  In  this  appendix;  will  be  permitted  to  be 
a differentiable  function  of  time.  Direct  calculation  yields  the 
dynamic  aquation  of  the  vehicle  In  the  transformed  coordinate  system 


/ C xn2  + Vcos  (;  -Y) 
x ( ; ) • I - d xnl-Vsec  (;-y) 


(D-161) 


where?  must  be  such  that  xplU)  is  monotono. 

Previously  a similar  class  of  transformations  were -considered  with  the 
Important  restriction  that;  be  constant.  To  facilitate  comparisons  among 
various  possible  selections  for  ;,  suppose  that  ihe  trajectory  error  at 
time  tj  Is  given  by 
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x(tj)  » e \ slnxj  (D-162) 

where  X is  a random  variable  uniformly  distributed  on  [0.2 it],  and  5 
Is  uncorrelated  with  X and  satisfies 

E (0  - O',  E (52)  - £y  (D-163) 

The  form  of  x(t^)  Is  easily  rationalized.  A position  error  of  amplitude 
c exists  in  the  (X-Z)  plane  in  a direction  characterized  by  X.  An  error 
In  flight  path  angle  also  exists  at  time  t..  The  relative  amplitudes  of 
the  position  and  angular  error  are  quantified  by  ly. 

It  Is  Important  to  note  that  a given  error  in  a time  based  model  at  the 
vehicle  will  appear  as  a different  error  In  the  coordinate  system  x . The 
most  obvious  reason  for  this  Is  the  fact  that  no  perturbation  can  be 
perceived  In  the  direction  of  Independent  varalble  x^.  Hence,  there  Is 
an  aliasing  of  errors  when  different  coordinant  systems  are  compared.  In 
order  that  H provide  a comparison  of  docility  for  different  vehicle  des- 
criptions, a common  Initial  perturbation  Is  a requisite. 


The  choice  of  x(t^)  given  by  (D-162)  generalizes  that  used  previously 
slightly.  Direct  calculation  as  suggested  in  this  reference  yields 
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(Y-C0)(l+secfc(Y-c0)) 


(D-164) 


The  contribution  of  to  docility  Is  independent  of  as  would  be  expec- 
ted since  y Is  left  Invariant  by  the  transformation  T„.  The  position  com- 
ponent can  be  minimized  by  selecting  Y . Then 
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H(C-Y) 


aV4 


4* 


(D-165) 


While  the  substitution  of  C0"Y  in  (D-164)  is  appealing,  it  violates  the 
constraint  thatCbe  constant.  Hence  (D-165)  could  be  satisfied  at  a 
single  point  on  the  trajectory,  but  it  could  not  hold  uniformly.  Since 
terminal  miss  Is  an  Important  performance  contributor,  an  attractive  can- 
didate guidance  law  sould  be  one  which  was  locally  most  docile  near  Im- 
pact; 1 .e.  C0*  Y (t^).  Such  a guidance  law  would  tend  to  be  less  favor- 
able In  the  early  stages  of  re-entry. 


Because  of  the  allure  of  the  trajectory  dependent  rotation  C “ Yp,  the 
appendix  outlines  the  calculation  of  H(C*Y_).  This  calculation  1$  made 

N H 

difficult  because  of  both  the  time  variable  and  stochastic  nature  of  the 
sample  of  paths  of  t.  To  compute  the  docility  index  fort*  yp,  observe 
that  from  (D-161) 


(D-166) 


In  (D-166)  and  the  equations  which  follow,  the  dependence  of  the  variable 
on  twill  be  suppressed  since  only  the  single  transformation  TR(t  * 'Y  ) Is 


being  considered, 
that 

dx„ 


37 


Pi 


Under  the  usual  monotonicity  assumptions,  it  follows 
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where  A«  xj)2  * A V*- . To  compute  the  performance  of  the  regulator  assoc- 
iated with  (D-166),  the  dynamic  equation  of  the  perturbation  variables 
must  be  computed  (See  D-66) 

d*r 

HxT  * Frxr  * Grur 
Pi 

where 

F - 3 fr| 


Returning  to  (D-167)  and  no 

(0  0 
-a’1  V 

0 A 

To  compute  the  docility  Ind 

must  first  be  evaluated.  A 

C Is  given  by 
n 3 

c2-[mo,Mi  ... 

Mq  - Gr  (0-1139) 

Mk+1  " ' FrMk  + 

Clearly  the  system  described  by  (D-167)  cannot  be  controllable  In  the 
usual  sense  since  Its  first  coordinate  is  degenerate.  For  the  purpose 
of  this  study,  the  system  (D-167)  will  be  said  to  be  controllable  if  the 
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ting  that  A Is  the  scalar  actuating  signal 
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(D-168) 


ex  H,  the  controllability  matrix  of  (Fr,G  ) 
s Is  well  known,  the  controllability  matrix 


n-an 
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space  orthoglnal  to  (1,0,0)  Is  In  the  controllability  subspace. 

It  was  shown  In  previously  that  if  xp^(t2)  ”xpi( ^ " dx  1s  small 
P(x(t1) ;dt)  - dXpf1  x‘(tt)  W’1(t1,t2)x(f1) 


where 


« dx  ,^+^+2^ 

W(t  ,t2)  • E & 

1 4 1 j-o  1 1 J ! (1+j+l) 
1»o 


Mt(t0)  Mj(t0) 


For  small  dxpl  It  was  further  shown  that  there  Is  a natural  decomposition 
of  the  controllability  subspace  Into  directions  which  differ  In  their 
power  content.  Specifically  If 

nl  - M0 1 1 Mq 1 1 -1 


then 


p ( n 1;  dxpl)  MlMjr2  dxpl‘2  (D-170) 

Or  If  C Is  such  as  o make  ||n2||  " 1 and 

n2  ■ C(H1  * V WV"‘  m„> 

then 

P (n2i  dxpl)  * | ( n2'  ng)'1  dxpl"4  (D-171) 

Since  the  derivation  of  (D-170)  and  (D-171)  Is  contained  In  Appendix  D-2, 
It  will  not  be  repeated.  It  might,  however,  be  useful  to  review  the 
Intuitive  meaning  of  these  relations.  Comparing  (D-170)  and  (D-171),  it 
Is  clear  that  errors  In  the  direction  require  far  less  control  energy 


D-89 
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for  their  eradication  than  do  e/rors  in  th'en^  direction.  The  reason  for 
this  is  quickly  discernible.  The  "easy"  direction^  Is  seen  to  be  along 
Gp,  the  direction  of  direct  Influence  of  the  actuating  signal  ur  in  (D-67). 
The  "hard"  direction^  is  orthoglnal  to  Gr.  For  the  controller  to  reach 
an  error  In  then?  direction,  It  must  work  through  the  system  dynamics 
(See  the  F and  Gr  terms  In  (D-169).  Since  the  ^ direction  can  only  be 
Influenced  through  the  "low  pass"  Intermediary  of  the  system  equation 
(0-166),  the  power  required  to  eliminate  the  h2  error  In  a short  time 
Interval  becomes  quite  large. 

From  (D-170)  and  (D-171)  It  follows  directly  that 


(0-172) 

Equation  (D-172)  has  a rather  Interesting  but  subtle  interpretation. 

From  (D-93)  It  follows  that  Is  a position  variable  and  xp3  Is  flight 
path  angle.  Because  xni  Is  large  over  most  of  the  trajectory,  (0-172)  in- 
dicates that  a position  error  Is  "easy"  to  correct  while  an  error  In 
flight  path  angle  Is  "hard".  This  Is  counter-intuitive  because  (D-89) 
shows  that  an  acceleration  acts  directly  on  flight  path  angle,  and  Indeed 
if  C were  constant,  the  regulator  always  finds  Y to  be  the  easy  variable 
to  control.  The  reason  for  this  anomalous  behavioral  characteristic  lies 
In  the  fact  that  the  coordinate  system  defined  by  TR  Is  now  Influenced  by 
the  controller.  The  punctilious  response  Induced  by  J results  In  the 
curious  relationship  of  and  Hg. 


To  compute  the  power  figures  given  In  (D-170)  and  (D-171),  note  that 
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(D-173) 


If  we  assume  that  A and  V are  slowly  varying  and  xnl  Is  large 
0 

Mj  «[  “A-1V  (A*1  t 2A'3  xnl2)]  (0-174) 


2 A-1V  a“3X 


nl 


Substituting  (D-172)  - <0-174)  Into  (0-170)  and  (0-171)  yields 


p(nli  dxpl)  - xnl“2  aW  (dt)“2 
p(n2i  dXpj)  " J A’2V2xnlV2  (dt)"3 


(0-175) 


where  it  has  been  noted  that  dxpl  ■ AV-1Adt. 

(D-175)  gives  the  power  content  of  unit  errors  In  thehj  andn2  directions. 
Because  a given  Initial  error  will  be  transformed  by  T(  ; ) Into  a dif- 
ferent error  In  the  xr  - coordinate  system,  an  amplitude  normalization  Is 
required.  It  can  be  shown  directly  that  IfC-i^,  a constant,  then 


(0  0 

-slnYsec  (y-Cq)  cos  y sec  (Y-C  ) 
-AV“2cosc0  sec(Y-t0)  -AV‘2s1nC0sec(Y-4Q) 


(0-176) 
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(D-177) 


When  c«Yp  things  are  more  complex.  Note  first  that  1 f Yp  ■ Y^ 

^xp  " xn  + ^R^  ^xn 

Suppose  the  error  at  time  Is  given  by 


J 


Hence 


v-e 


rl 


U*n2  + co»(X-Y))-5xnl  + sec(X-Y)  J (D-179) 
A-1  (5xn2  + cos  (X-y))‘  + 5 


By  way  of  comparison,  If 


xr(;0) 


sec  (Y-:o)  sin  (X-y) 

-AV'Z  s«c(y-C0)  cos  (x-Cq)  + $/ 


To  determine  the  components  of  x In  then,  andru  directions,  note  that 
If  xnl»l 


n1*  Xr  * e Xr2  (D-180) 

n2‘  *r  • c Xnl-l  sin  (X-y)  (D-181) 

Let  (0-180)  and  (0-181)  be  the  amplitudes  of  the  errors  In  the  and  n2 
directions  respectively.  Suppose  further  that  X Is  uniformly  distributed 
on  [0,2rr],  that  X Is  uncorrelated  with  5 and  that 

u • o,  m2  - 2y 


Then  substituting  these  relations  Into  (D-159) 

■p,  6 ■ EY  (1+  A 1 xn2 


H(C.y„)  • §- 


,2,3 
) + 2T  X 


■2.  L 
nl  +T 


-2 


2xm'V1' 


n 


(0-182) 
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Direct  calculation  from  (D-159)  yields 


HU-C0) 


(Y-Co)  (l  + s1n2.(Y-50)) 


(D-183) 


If  A and  V are  nearly  constant,  a comparison  of  system  performance  using 
constant  and  variable  d Is  made  easier  If  the  docility  Index  Is  parameter- 
ized In  terms  of  R and  8 (See  Figure  0-10)  Direct  calculation  yields 


H<;-Yp) 

H(OY0) 


- sec  0)2  + ^p(3csc29  + sec20  - -.sec  0csc9 


b-2  p 

+ Y*  sec  (Y-C0) ( 1 + sec^Y-Cp)) 


(D-134) 


Comparing  (D-I64)  and  (D-1841,  It  Is  clear  that  d “ Yp  shows  an  Improvement 
over  d ■ dQ  on  the  order  of  V2 . 

The  result  given  In  (0-184)  Is  Initially  rather  surprising.  As  expected 
d ■ Yp  Is  superior  to  any  constant  value  for  d when  H Is  considered  over 
the  whole  trajectory.  Still  the  Improvement  factor  is  quite  large  on  the 
trajectories  considered.  The  reason  for  the  pronounced  enhancement  of 
regulator  performance  lies  In  the  way  errors  are  measured  when  d is 
trajectory  dependent.  For  now  suffice  It  to  say  that  letting  d * ;p 
adds  a new  degree  of  flexibility  to  the  regulator  given  by  (D-68).  To 
see  this  observe  that  the  analyst  studying  the  performance  of  the  regu- 
lator associated  with  d ■ dp  may  select  dQ  to  provide  good  performance 
on  one  segment  of  the  trajectory.  Still,  once  dQ  Is  chosen,  system 
behavior  Is  circumscribed  by  the  restrictions  Inherent  In  the  fixed  coor- 
dinate system.  In  contrast,  d • Yp  Is  not  fixed  Initially  and  In  fact 


Figure  D-9.  Parameterization  of 
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will  change  as  a function  of  trajectory  errors.  More  fundamental,  Y Is 
a controllable  quantity.  Therefore,  when  ;*Yp  the  regulator  can  actually 
control  the  coordinate  system  In  which  errors  are  measured.  The  way  In 
which  the  regulator  utilizes  the  pliancy  of  the  coordinate  system  Is 
rather  cunning. 
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APPENDIX  E 

ADDITIONAL  STEERING  LAW  TOPICS 


In  this  appendix,  two  topics  related  to  the  general  problem  of  development 
of  steering  laws  for  an  aerodynatnlcally-controlled  reentry  vehicle  are 
considered. 

In  Section  E-l,  the  Influence  of  autopilot  states  In  the  calculation  of 
controller  gains  calculated  using  the  LQ  regulator  formulation  Is  examined. 
This  analysis  is  motivated  by  the  potential  reduction  In  model  size 
achievable  If  the  Influence  of  the  autopilot  states  Is  weak. 

In  Section  E-2,  certain  aspects  of  Imperfect  state  estimates  and  their 
relationship  to  the  LQ  regulator  used  for  the  steering  law  (or  controller) 
are  examined.  This  analysis  Is  motivated  by  the  realization  that  the  on- 
board sensors  are  Imperfect  and  Indeed  can  also  experience  failures. 

E-l.  INFLUENCE  OF  AUTOPILOT  STATES  ON  SYSTEM  PERFORMANCE 

E-l. 1 Introduction 


Simulation  of  the  nonlinear  model  of  an  aerodynaml call y-control led  reentry 
vehicle  has  Indicated  a potential  source  of  Instability  associated  with 
the  autopilot  loops.  The  LQ  regulator  portion  of  the  guidance  law  Is 
derived  on  the  premise  that  the  vehicle  states  are  continuously  observable 
and  the  actuating  signals  vary  In  response  to  changes  In  state.  Actually, 
guidance  Is  accomplished  from  sampled  observations  of  state  errors,  and  If 
the  guidance  loop  gains  are  too  high,  unpredicted  Instability  can  occur. 
This  problem  has  proved  to  be  particularly  troublesome  In  the  autopilot 
loops  when  autopilot  states  are  Included  In  the  guidance  law. 

Stability  margins  In  the  nonlinear  model  can  be  significantly  Improved  by 
the  simple  artlface  of  reducing  or  eliminating  the  penalties  associated 
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with  the  autopilot  errors  in  the  performance  Index.  Small  weighting  on 
autopilot  errors  tends  to  yield  small  feedback  gains  and  this  in  turn 
minimizes  the  stability  problems  created  by  sampling.  Indeed,  satisfactory 
system  performance  has  been  attained  by  simply  setting  the  autopilot  gains 
equal  to  zero. 

This  latter  observation  suggests  that  the  dynamic  properties  of  the  auto- 
pilot may  not  be  essential  In  the  gain  calculation  for  the  LQ  regulator 
guidance  law.  If  the  autopilot  could  be  eliminated  from  the  linear  vehicle 
model,  this  would  simplify  considerably  the  solution  of  the  Rlccatl  equa- 
tion which  Is  an  Intermediate  step  in  the  gain  calculation.  There  would  be 
fewer  weightings  to  be  selected  in  the  performance  Index  and  the  overall 
design  problem  would  be  made  easier. 

This  appendix  gives  the  results  of  a study  of  the  Influence  of  model  simpli- 
fication on  closed-loop  performance.  The  results  are  preliminary  In  that 
only  the  properties  of  the  linear  perturbation  model  are  explored.  A more 
complete  analysis  will  require  simulation  of  the  nonlinear  vehicle  model 
to  validate  the  results  derived  here. 

E-1.2  Model  Reduction 

Suppose  the  dynamical  equations  of  the  perturbation  variables  (x,u) 
satisfy  the  linear  differential  equation 

x ■ F(t)x  + G(t)u  ( E-l ) 

x(tQ)  - xQ 

The  advanced  guidance  law  Is  that  feedback  regulator  which  minimizes 

r*  f 

J " x(tf)'  Pf  x(tf)  + / (x'Qx  + u'Ru)dt  U-2) 
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The  structure  of  the  advanced  guidance  law  has  been  explored  In  many 
references  (see  for  example,  Reference  E-l)  and  the  form  of  the  guidance 
law  can  be  given  explicitly 

u ■ -R'Vpx  (E-3) 


subject,  to 

p « -F'P  - PF  + PGR_1G’P  - Qi  tQ  < t < tf  (E-4) 

P(tf)  • Pf 

Although  not  usually  of  great  significance,  the  cost  J can  be  evaluated 
for  a variety  of  linear  control  laws.  Denote  by  uM  the  guidance  law 
given  by 

u^  ■ -R“lG'Mx  (E-fi) 

where  M Is  a nonnegative  symmetric  matrix.  From  (E-3)  the  advanced  guid- 
ance law  Is  given  by  u^. 

Let  JM  be  the  performance  associated  through  (E-Z)  to  the  control  uM. 
Suppose  that  It  Is  possible  to  write  0^  In  the  form 

■ X(t0>'  W *(tO>  tE-6> 

for  ,11  t.  s t,.  Thon 

0 T 


3dM(t0) 


*(*<>) ' PM(to)x(to)  + + X'V 


From  (E-l)  and  (E-5) 


x ■ (F  - GR"1G* M)x 


(E-7) 


(E-8) 
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Differentiating  the  right  side  of  (E-2)  with  respect  to  t , it  follows 

that 

■ -x(t0)'  q(t0)  X(t0)  - u'(t0)R(t0)u(t0)  (E-9) 

Combining  (E-7)  and  (E-9) 

■ -(F  - GR'l0'M)'PM  - PM  (F  - SR"1G,M)  - Q - MGR"lG'M  (E-10) 

W ■ pr 

If  we  substitute  M ■ P in  (E-10) 

Pp  * -(F  - GR'lG'P)‘Pp  - Pp  (F  - GR‘lG'P)  - Q - P GR'lG'P.  (E-ll) 

V V ' Pf 


Comparing  (E-4)  and  (E-ll),  it  is  clear  that 

Pp"  p 

and  as  a consequence  the  performance  of  the  regulator  up  Is  given  by 

0 - x(t0)'Px(t0).  (E-ISO 

Thus,  In  addition  to  Its  role  in  the  gain  calculation,  P Is  actually  tho 
"cost"  matrix  as  well . 

Supose  that  M is  nearly  equal  to  P;  i.e. 


M - P + 6P;  | | 6P| | < < | |P| | 
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Denote  t.  <5PM  the  corresponding  variation  In  PM; 

PM  " P + (E-13) 

From  (E-10) 

PM  " p + 

- -(F  - GR_1G'  (P  + 6P))‘  (P  + 6Pm)  - (P  + 6PM)  (f  - GR"lG'  (P  + 6P)) 

-Q  - (P  + <5P)  GR^G'fP  + 6P) 

Using  (E-ll) 

<SPM  - -(f  - GR-1G'(P  + «P))'6Pm  - 6PM(F  - GR-1G'(P  + 6P)) 

- <SP  GR-1G ' 6P  (E-14) 

<5P^(t^)  * 0. 

To  gain  Insight  Into  the  structure  of  (E-14)  consider  the  following  Identity. 
Let  A ( t ) be  defined  ly 

A(t)  * / (eA  B eA^t'T^)dT  (E-15) 

t 

Then 

« -B  + J ^3  (eA'^t_T)BGA^t'T^)dT 

t 


E-5 


-B  + A'A  + AA 


(E- 16) 
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dA 

Ht 


A(tf)  - 0 


Comparing  (E-14)  and  (E-16),  assuming  the  coefficient  matrices  in  (E-14) 
are  nearly  constant  and  using  the  fact  that  P + 5P  a P 


4P. 


,(tg)  « /.  * ■ « 5 p^'  (tO  *TW  GR* lG'4Pc‘*F  ‘ 6R'1(*,p)' 


[tO  * T)dT 


( E- 17 ) 


F - GR^G1  Pi 

If  (F,G)  is  controllable,  the  maximum  eigenvalue  e ' ' can  be 

used  as  a norm  of  the  matrix  exponential.  Clearly 

ll<PM(t„)|l  « (tf  - t0)  ||8R*1G'|l  ! |SP| I2  (E-18) 

Consequently,  a variation  In  P gives  no  first  order  change  in  1 . e . 

ir  “ 0 (E_19) 

M » P 


The  sensitivity  of  system  performance  to  changes  In  gain  is  zero  near 
-R"*G'P.  Any  changes  In  the  system  model  which  create  small  changes  In 
gain  will  cause  essentially  no  change  in  system  performance. 


r 


i 


I 


i 
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The  small  sensitivity  to  gain  changes  is  important  In  this  application 
only  If  we  can  show  that  the  desired  changes  in  system  structure  give  rise 
to  small  changes  in  gain.  Elimination  of  the  autopilot  states  changes  the 
order  of  the  system  equations  and  Is  not  a small  variation  in  the  usual 
sense.  Suppose  F and  G experience  perturbations  4F  and  <SG,  resepctively. 
The  corresponding  value  of  the  cost  matrix  becomes 


P+6P  - -(F+6F)'(P+6P)-(P+4P)(F+6F)+(P+5F)(G+6G)R’l(G+6G)'(P+6P)-Q 


Consequently 


5P  ■ -(F  - 5R‘lG'F)'  SP  - 6P  (F  - grt'P)  (E-20) 

-P  (iF  - 6GR"1G,P)  - (6F  - 6GR-1g'P) ' P 
<5P(tf)  - 0 


where 


F ■ F + 5F,  G - G + SG,  F - P + 6P 

The  equation  for  P has  the  same  stability,  properties  as  does  that  for  the 
P matrix  associated  with  the  perturbed  system.  It  follows  from  (E-20) 
that  1 1 <5  P j | will  be  small  If  ||P(sF  - sGR“15,F)||  is  small.  One  of  the 
factors  is  fairly  obvious.  If  5F  and  jG  are  small,  then  G a S.  Con- 
sequently, <sF  - 5GR"%'F  Is  small  If  the  first  variation  In  the  closed- 
loop  dynamic  matrix  Is  small.  A small  change  in  the  closed-loop  system 
dynamics  will  produce  a small  change  in  P,  but  the  converse  is  not  as 
strong.  To  gain  more  insight  into  the  effect  of  the  autopilot  states,  a 
simple  example  is  useful. 
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AN  EXAMPLE 


Suppose  we  consider  a simple  trajectory  In  the  plane  described 


X ■ cosy 
» 

Z ■ slny 
y ■ A 

A - an(A  - Ac) 


(E-21) 


The  variables  have  the  obvious  Interpretation  and  an  Is  the  nominal  corner 
frequency  of  the  acceleration  command  autopilot.  The  perturbation  equations 
associated  (E-21)  are  easily  derived  and  have  the  form  given  In  (E-l)  with 


0 0 -slny  0 


0 0 cosy  0 


0 0 
0 0 


1 . G 


(E-22) 


Suppose  we  wish  to  Investigate  the  influence  of  the  autopilot  state.  One 
way  In  which  the  autopilot  can  be  effectively  eliminated  Is  to  set  the 
autopilot  corner  frequency  equal  to  aM  where  aM  > > 1. 


0 0 0 
0 0 0 
0 0 0 


0 0 0 aM  - an 


an  * aM 


(E-23) 


— _ ntttn.'w ? 
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Clearly,  neither  6F  nor  <5G  Is  small. 

Let  us  partition  P,  F,  G,  and  Q as  follows: 


p 


pil  p12 

LP21  P22 J 


*11 
0 0 


(E-24) 


where  P22,  F22*  s2’  *tc< ara  scalars  and  the  other  elements  are  of  compatible 
dimension.  We  will  assume  that  weighting  Q on  state  errors  provides  no 
penalty  for  deviations  In  autopilot  state  from  nominal.  Since  the 
actuating  signal  Is  one  dimensional,  R Is  scalar  and  will  be  denoted  by  r. 


Expanding  (E-4)  and  noting  that  P Is  symmetric 


PU  " “F11P11  “ P11F11  ’ P12F2l  “ F2lP12  ' Q11  + “r“  P12P12 


G, 

P22  " ”2F22P22  " P21P12  “ F2l'P2l'  * T P22 


(E-25) 


P12  " "PUF12  “ P12F22  * Fll'P12  ‘ F21,p22  + 4"  P12P22 

^ 12 C t f ) ■*  0,  P22^f)  " * 


Let  us  assume  that  an  and  therefore  F22  Is 
that  P12  and  P22  are  of  comparlable  norm. 


'2F22P22 


large  compared  to  one  and 
Then 


(E-26) 


The  nontrivial  stationary  value  of  P22  Is  given  by 


o , . Hip.  . 2i 


(E-27) 


Suppose  Pj2  from  th*  solution  given  In  (E-27)  by  a small  amount 

c.  Then 


U9  9 iU, 

*2F22^P22  + + *7”  ^P22  + c’  * ^“2P22  + T“  P22^e 


■ *F22S 


From  (E-26)  then 


e - 2F22e 


(E-28) 


In  (E-28),  F22  ■ afl  and  an  > 0.  The  stability  properties  of  (E-2Q)  are 
more  easily  seen  If  we  use  the  change  of  variable  t ■ tf  - t.  Equation 
(E-28)  becomes 


■ -2a_e 


(E-29) 


Equation  (E-29)  Is  stable  thus  suggesting  that  P22  Is  very  close  to  the 
value  given  In  (E-27)  for  all  t outside  of  a small  Interval  containing  tf. 

Next,  let  us  look  at  P^2  in  more  detail.  From  (E-25) 


P12  ■ -(Fil  + <f22  - -f  P22>  0 P12  ' FUF12  (E-30> 


LOGICON 


'll  " r P22  “an 


P12  ’ “(F11  “ anI)P12  " P11F12 
By  assumption  a I > > Fi,  and  thus 


P12  " anP12  " PHF12 


(E-31) 


The  stability  properties  of  the  equation  for  P^  In  (E-31)  are  those  ex- 
hibited by  c In  (E-29) . Consequently, 


P . pnFi2 


(E-32) 


Me  are  now  In  a position  to  complete  the  analysis  of  the  P equation  by 
looking  at  P^.  Since  F21  ■ 0. 

G 2 

F11  ' -Fnpu  • PUFU  - °u  + 4-  P12Piz  (E-33) 


p p'  . La  pnFi2Fi2pi 
r r12K12  p TZ 

a n 


■ PUFlZr"lFi2PU 


I 
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Consequently 


pii  ■ -Fupn  ' pnFn  ' On  * puF«r'  fkpu  (e-m1 


Equation  (E-34)  Is  precisely  the  equation  that  would  result  If 


F * 


F11  0 


6 - 


12 

0 


(E-35) 


From  the  preceedlng  equations  It  becomes  clear  that  If  the  autopilot 


corner  frequency  an  Is  large, 


22 1 


0(ji) 

*n 


lp12ll  -O(jl) 

°n 


(E-36) 


The  limiting  value  of  Pj^  Is  that  which  would  be  associated  with  a reduced 

order  model  containing  no  autopilot  dynamics.  If  we  assume  that  au  > > a , 

m n 


PM<to>  « 


<Vu  o 


or 


IlfiPl 


O(t^) 

an 


(D-  (E-37) 


From  (E-37)  It  Is  evident  that  the  large  magnitude  variation  in  F and  G 
gives  rise  to  a small  variation  In  P.  Because  of  the  small  closed-loop 
sensitivity  to  variations  in  gain  (see  E-19)),  the  system  performance 
will  be  unaffected  by  the  elimination  of  the  autopilot  state  In  (E-21) 
If  the  nominal  corner  frequency  an  Is  high. 
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E-1.3  Conclusions 

This  section  has  provided  a preliminary  analysis  of  the  Influence  of  elim- 
ination of  autopilot  states  on  closed-loop  system  performance.  If  the 
autopilot  dynamics  are  neglected,  certain  stability  problems  are  reduced 
and  the  calculation  of  the  guidance  gains  Is  made  simpler.  Because  the 
effective  order  of  the  system  dynamic  equation  is  reduced,  the  removal  of 
the  autopilot  does  not  correspond  to  a small  variation  In  the  [F,  G] 
matrix.  Consequently,  the  usual  perturbation  arguments  can  not  be  used 
to  study  performance  sensitivity. 

The  proof  that  autopilot  states  are  of  little  Importance  proceeds  In 
two  parts.  First,  It  was  shown  that  linear  regulators  with  gains  close 
to  those  appropriate  for  the  advanced  guidance  law  have  performance  that 
Is  Indistinguishable  from  that  attained  with  the  correct  gain.  This  Is 
a general  property  of  the  advanced  guidance  law.  Small  gain  errors  from 
whatever  source  have  negligible  Influence  on  performance. 

The  next  step  Is  to  show  that  a change  In  system  order  yields  a small 
change  In  gain.  In  contrast  to  the  preceeding  sensitivity  property,  the 
Influence  of  order  reduction  makes  essential  use  of  the  structure  of 
[F,  G]  . Order  reduction  causes  a big  change  In  L'.'a  nominal  dynamical 
matrices  of  the  linear  perturbation  model.  To  show  that  the  ensuing 
gain  change  Is  small,  requires  more  than  a sensitivity  argument  because 
second  and  higher  order  perturbation  terms  must  be  retained.  One  may 
either  show  that  the  solutions  to  (E-2G)  are  small  or  show  directly  that 
the  value  of  P corresponding  to  [F,  G]  Is  close  to  that  associated  with 
[F,  G]  . It  was  shown  by  example  that  for  motion  In  the  x-z  plane,  the 
acceleration  command  autopilot  has  little  Influence  on  system  performance 
If  the  nominal  autopilot  corner  frequency  Is  high.  It  is  expected  that 
a similar  conclusion  would  follow  from  analysis  of  the  seven  dimensional 
models  for  motion  In  R . 
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r; 


Since  only  the  dominant  terms  in  the  Rlccatl  equation  were  retained  In 
this  analysis,  It  Is  Impossible  to  state  quantitatively  how  large  an  must 
be  to  perm't  its  benign  neglect.  A more  detailed  analysis  would  be  neces- 
sary to  provide  this  type  of  Information. 
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E-2.  INFLUENCE  OF  SENSOR  FAILURES  ON  LQG  REGULATORS 

E-2.1  Introduction 


The  solution  to  the  linear-quadratic  Gaussian  (LQG)  regulator  problem  has 
a number  of  attractive  features  which  suggest  Its  use  In  applications  (see 
Reference  E-2).  The  synthesis  algorithm  leads  to  a linear  feedback  regu- 
lator with  gain  given  by  the  solution  to  a matrix  ordinary  differential 
equation.  The  controller  Is,  thus,  relatively  easy  to  Implement.  Of  pri- 
mary Interest  In  this  paper  Is  another  Idlosyncracy  of  the  LQG  regulator; 
certainty  equivalence.  As  pointed  out  by  many  Investigators,  the  LQG 
regulator  has  a natural  decomposition  Into  a filter  which  generates  the  best 
mean-square  estimate  of  the  system  state  and  a fixed  gain  controller  Inde- 
pendent of  the  observation  mechanism.  This  latter  property  Is  desirable 
In  on-line  applications  because  to  make  the  controller  parameters  contingent 
on  the  realization  of  the  exogenous  Influences,  would  yield  a system  of  un- 
acceptable complexity. 

This  appendix  considers  a situation  of  a somewhat  more  general  sort.  Speci- 
fically, concern  Is  centered  on  the  Influence  of  changes  In  the  observation 
equation.  The  motivation  for  this  work  was  a study  of  the  operational 
characteristics  of  reentry  vehicles.  Such  systems  have  continuous  sensors; 
e.g.,  an  Inertial  measurement  package;  and  may,  at  discrete  time  points, 
make  additional  position  measurements  using  a separate  group  of  sensors. 
Particularly  these  latter  measurements  are  subject  to  untoward  Influences 
due  to  both  environmental  effects  and  internal  failures.  It  Is,  therefore, 
of  Interest  to  determine  how  the  ragulator  should  be  modified  In  response 
to  these  events  of  uncertain  occurrence. 

There  are  many  excellent  papers  extolling  the  virtues  and  explaining  the 
limitations  of  LQG  regulators.  This  appendix  will  use  the  notation  con- 
ventions of  Tse  and  Reference  E-5  whenever  possible.  Of  particular  Inter- 
est Is  the  exploration  of  the  nuances  of  a supposition  of  Tse  to  the  effect 
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that  an  optimal  regulator  will  have  the  certainty  equivalence  property  If 
(Reference  E-3,  pg,  780): 

1)  The  conditional  mean  of  the  state  characterizes  the 
observation  o-fleld 

2)  The  conditional  mean  of  the  state  has  the  same  dynamical 
equation  as  does  the  state. 

3)  The  cost  Is  quadratic. 

E-2.2  Problem  Description 

The  system  to  be  controlled  and  the  feedback  link  will  be  described  by 
linear  equations  (see  Reference  E-2): 


x-Ax+Bu+$0<t<T  (E-38) 

y ■ Cx  + 9 (E-39) 


where  x Is  the  system  state,  u the  actuating  signal,  and  y the  observation 
signal.  The  signals  £ and  e are  white  noise  processes  Independent  of  each 
other  and  Independent  of  x(0)  where  x(Q)  Is  Nor  (xQ,  s(0)).  Fcr  reasons 
that  were  explained  In  the  Introduction,  It  Is  advantageous  to  generalize 
the  observation  equation  (E-39)  slightly.  Let  I be  a discrete  set  with 
elements  {tj,,..,  tn>  and  assume 


E £(t)  ■ 0 ; E £(t)  ?(t)  - -( t)  5 (t  - x ) 


E 9(t) 


0 


E e(t)  s(t) 


/0(t)  5(t  - t)  t * I 
■<©( t ) t ■ t e I 

\ 0 Otherwise 


(E-40) 


The  feedback  link  transmits  continuous  aggregated  observations  of  the  sys- 
tem state  with  white  additive  noise  except  for  a discrete  set  of  times  of 
which  a higher  quality  set  of  observations  Is  transmitted.  These  latter 
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observations  may  differ  In  type  from  the  former,  and  C may  be  discontinuous 
on  I.  The  performance  index  Is  quadratic 


\ 


I 

I 

I 

1 

I 

1 


rT 

J ■ E [x'(t)  Sx(t)]  + / (x'Qx  + u'Ru)dt  (E-41) 

0 

where  S,  0,  and  R satisfy  the  usual  hypotheses. 

The  basic  element  which  distinguishes  this  problem  from  that  of  Tse  Is  the 
possibility  of  sensor  failure.  Let  the  random  process  r(t)  represent  the 
mode  of  operation  of  the  feedback  measurement  link  and  suppose  C and  0 
depend  upon  r;  l.e., 

(C(t),  o(t))  • (CjU),  O^t))  If  r(t)  - 1 (E-42) 

Thus,  the  feedback  measurement  gain  C or  the  observation  noise  level  e may 
change  In  some  random  fashion.  The  Indicator  variable  r Is  a finite  state 
Markov  process  characterized  for  small  L by: 

11  - Plj(t}a  + 0(a)  1 - J,  t * I 

p1 j(t)A  + 0(a)  1 i J,  t t 1 

0 ^ J ( t )A  + 0(a)  t c I 

(E-43) 

Let  N « [pij]*  "l"0  see  the  Implication  of  (E-42)  and  (E-43)  suppose  that 
r ■ 1 corresponds  to  normal  operation  and  r » 2 represents  a degraded  ob- 
servation; e.g.,  02(t)  > Oj(t)  or  Cg( t)  C2'(t)  < Cj(t)  C^'UJ.  Equation 
(E-43)  gives  a failure  "rate"  of  p12(t)  for  t { I.  If  N(t)  » I for  t e I, 
(E-43)  admits  the  possibility  of  failure  coincident  with  discrete  update. 
This  could  be  due  to  a component  overload,  or  to  the  fact  that  a prior 
failure  only  becomes  apparent  when  the  updating  sensors  are  interrogated. 
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If  the  realization  of  r were  known  a priori,  ( E- 38)  - (E-40)  would  delineate 
the  IQG  regulator  problem.  The  optimal  causal  control  policy  is  linear  and 
Equation  (E-38)  (formally)  generates  a Gaussian  random  process.  Under  (E-42) 
and  (E-43),  this  will  no  longer  be  true.  Let  te[0,  T]|  be  the  ob- 

servation u-fifilds  at  the  controllers 

J " «|y(T) . r(v);  tc[0,  t]|  (E-44) 

Note  that  perfect  measurement  of  r is  permitted  In  the  feedback  link.  This 
is  an  idealization,  of  course,  but  this  assumption  leads  to  a far  more 
analytically  tractable  problem.  The  basic  problem  is  to  find  a function 
u(t)  adapted  to  JL  such  that  (E-41)  is  minimized. 

E-2.3  Solution  Algorithm 

Before  considering  the  control  problem,  consider  first  the  problem  of  esti- 
mating x.  At  first  glance  this  might  appear  to  be  a formidable  obstacle 
because  of  the  random  coefficients  In  the  observation  equation.  Actually 
this  is  not  the  case.  Because  r(t)  is  measurable  and  a Markov  process, 
the  equations  of  evolution  of  the  conditional  mean  take  on  the  form  one 
would  Intuitively  expect.  A certain  amount  of  tedious  calculation  yields 
the  following  results:  Let 

ft(t)  - E |x(t)|  Z\)  (E-45) 

Then 

x ■ Ax  + 3u  + W^v;  r(t)  ■ i,  t i I 

x(t)  ■ x(t“)  + W1(t)v(t);  r(t)  « 1,  t c I (E-46) 

x(0)  - xQ 

where 
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/ ot(t)  ,s(t  - r);  t I I , r(t)  - i 
Ev  ■ 0;  Ev( t)v 1 ( r ) - ] 0 i ( t ) + Ci(t)r(t‘)Ci,(t);  t e l,  r(t)  - i 

\ 0 Otherwise 


w1(t)  « 

j j;(t)C1'(t)oi‘1(t)  ; t 1 I,  r(t)  • 1 

| n(t")ci • (t)  [ c1(t)r(t")c1 1 (t)  + 0<(t)j  -1  ; t s 

(E-47) 

I,  r(t)  ■ 1 

£(t)  - 

Ae  + SA'  - f 5 ; til,  r(t)  ■ 1 

(E-48) 

s(t)  ■ 

[i  - K,(t)Ci(t)]  E(t')  ; til,  r(t)  • 1 

( E-49 ) 

E(0)  - 

r0 

% 

Observe  that  If  t i I tho  equation  for  x "has  the  same  dynamic(s)  as  the 
original  process  except  with  different  driving  disturbance"  (Reference  E-3 
pg.  780).  For  t e I,  x may  have  discontinuities,  a property  not  shared  by 
x.  Note  that  the  nolso  Intensity  Is  random  In  (E-46)  both  through  W and 
the  covariance  of  v.  Particularly  the  former  depends  upon  the  past  history 
of  r through  Its  dependence  on  !),  Further,  W is  not  deterministic  as  was 
the  case  In  (E-2),  but  it  Is  adapted  to  o* 

Using  the  argument  of  Tse  in  toto  it  can  be  shown  that 

J - E { x'(t)  Sx(t)  f /*T(x'Qx  '•  u'Ru)dt  + Tr(Si:(T)  + f QAdr)} 

•'o  ■'o 

(E-50) 

In  contrast  to  the  LQG  problem,  the  last  two  terms  In  (E-50)  are  random. 
Because  the  last  two  terms  are  also  unaffected  by  the  control  policy,  a 
control  problem  of  a fairly  standard  sort  results.  It  is  shown  in  Section 
E-2. 6 that  the  optimal  quadratic  regulator  is  given  by 
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with 


where 


where 


u * -R_1B'  Kx  ■ ( E- 5 1 ) 

0 - x0*  K(0)  x ( 0 ) + Pr(0)(0)  + E | Tr(Si:(T)  QEdt)}  (E-52) 

K « -A'K  - KA  - KBR-1B'K  + Q 
K(T)  - S 

p ■ -Np  - r t c i 
p(t“)  ■ Np(t)  * r t f.  i 
p(T)  - 0 

p and  r are  vectors  with  elements 


(E-53) 

(E-54) 


p ■ £p^j  ; r - Jjr  KW^  < v v W ' 1 J 
E-2.4  Properties  of  the  Optimal  Regulator 


(E-55) 


The  most  Interesting  attribute  of  the  optimal  regulator  giver,  by  (E-51)  Is 
the  fact  that  the  certainty  equivalence  property  is  preserved  In  the  pre- 
sence of  sensor  failure.  The  evolutional  equations  of  x satisfy  the 
dynamical  equations  of  the  controlled  system  almost  everywhere,  and  this 
produces  the  desired  result.  The  resulting  closed-loop  system  does  not 

i 

have  Gaussian  solutions  because  of  the  multiplicative  influence  of  the 
random  process  r. 


It  1$  interesting  to  compare  the  result  derived  here  with  that  derived  In 
a closely  related  problem.  In  Reference  E-4,  full  state  feedback  was  per- 
mitted and  consequently  x » x.  In  this  reference  the  times  of  discontinuity 
were  not  predictable  as  they  are  here.  Even  after  factoring  out  some  other 
dissimilarities  In  the  statements  of  the  two  problems,  a fundamental  dif- 
ference In  the  solutions  remains.  The  primary  reason  for  this  Is  the  fact 
that,  the  change  in  state  at  points  of  discontinuity  i.i  Reference  E-4  was 
"multiplicative";  i.e., 
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x(t)  * T^x(t')  if  r (t)  a j,  r(t")  * i, 

while  that  of  (E-46)  Is  additive.  Although  the  system  of  Reference  E-4 
satisfies  all  of  the  deslrata  of  Tse,  separation  In  Its  strongest  form, 
(E-51)  falls.  In  the  referenced  problem,  the  control  component  of  the 
optimal  regulation  policy  Is  Independent  of  the  additive  noise  terms  but 
depends  explicitly  on  r,  and  consequently  can  be  seen  to  possess  a weaker 
form  of  separation.  In  both  cases  the  "filter"  portion  of  the  regulator 
depends  upon  the  exogenous  variables. 


Though  (E-51)  Is  unrelated  to  sensor  reliability,  the  same  Is  not  true  of 
the  performance.  Equation  (E-52)  has  a natural  decomposition  Into  a state 
Independent  term  related  to  filter  performance.  The  components  of  this 
latter  term  proportional  to  E(r)  clearly  Increase  as  the  likelihood  of 
failure  Increases.  The  driving  term  In  the  p equation,  r,  Is  proportional 
to  C'C  and  Inversely  proportional  to  0.  The  Pr(0)(°)  component  of  cost  tends 
to  decrease  with  Improved  filter  performance.  While  these  terms  can  not  be 
expected  to  cancel,  they  do  provide  some  measure  of  compensation. 

The  structural  result  given  by  (E-51)  and  (E-53)  can  be  generalized  weakly 
to  the  case  where  the  parameters  of  the  open-loop  system  (E-38)  vary  with  r. 
Using  classical  techniques,  It  can  be  shown  that  If  2 depends  upon  r,  (E-51) 
and  (E-53)  still  give  the  control  portion  of  the  optimal  regulator.  If, 
however,  (A,  B)  varies  with  r,  the  gain  In  (E-51)  must  be  made  contingent 
on  r.  This  effect  was  observed  In  the  noise-free  problem  with  random  jump 
parameters. 

E-2.5  Conclusion 


This  appendix  has  considered  the  Influence  of  changes  in  the  parameters  of 
the  observation  equation  on  the  feedback  regulator  optimal  with  respect  to 
a quadratic  performance  Index.  The  feedback  gains  were  seen  to  be  unaf- 
fected by  sensor  variability  of  a specified  type.  This  characteristic 
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has  important  practical  implications  because  the  controller  gains  are  often 
stored  on  a special  purpose  computer  for  on-line  implementation  of  the 

regulator. 

The  underlying  explanation  for  the  strong  separation  displayed  by  the  con- 
troller lies  In  the  passive  nature  of  the  learning  task  as  perceived  by  the 
controller.  This  avoids  the  dual  control  problem  which  would  arise  If  r 
were  not  perfectly  sensed.  As  pointed  out  by  Tse  In  Reference  E-3,  the 
dual  control  problem  will  admit  no  such  easy  solution  as  obtained  here. 

E-2.6  Proof  of  Equation  E-51 

The  proof  of  (E-51)  follows  the  standard  formalism  of  dynamic  programming. 
Let  J*  (t,  x(t),  r(t))  be  the  minimum  cost  to  go; 

0*( t,x(t)  i r(t) ) - E |x'  (T)Sx'(T)  + ^ (x1  Qx  + u'Ru)dx| 

t (E-56) 

It  Is  well  known  that  J*  satisfies  an  equation  of  the  Bellman  type 

0 ■ min  ((x'(t)Qx(t)  + u(t)Ru(t))dt  + E |dJ*|v>\  l ) (E-57) 

u(t)  1 

Generalizing  Reference  E-5  to  the  vector  caie 

dJ*(t,x(t);  r( t ) ) ■ Jt*cit  + dxdx(t)  + 'i  Tr(0*xd  < xc,  xc  >) 

+ d*(t),  x(t),  r(t) ) - 0*(t,x(t"))  - ax{ t)  (E-58) 

A A 

where  x and  ax  are  the  continuous  and  discontinuous  parts  of  x,  respect- 
Ively.  From  (E-46) 

< *c*  *c  > * W^Q^W|'dt  (E-59) 
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Substituting  (E-58)  and  (E-59)  into  (E-57) 


min  x * Rx  + u'Ru  + J*(t,x,1)(Ax  + Bu)  + »s  Tr(J*x(t,x, 0)1^0^ ' 


+ I o1 jJ*( t,x(t) , j) 


j 


If  t i 1,  r(t)  - 1 


(E-60) 


mlnz  p1jJ*(t,x(t),  j)  - J(t,x(t“),  1)  If  t c I,  r(t)  ■ 1 


u j 


(E-61) 


Note  (E-61)  Is  control  Independent. 


If  we  assume  that  J*  has  the  form 


J*(t,x,r)  - x'Kpx  + pr 


(E-62) 


then 


u - -R-1B'K^x  If  R(t)  - 1 (E-63) 

Note  that  u In  (E-63)  Is  used  for  all  t since  I Is  discrete.  Direct  sub- 
stitution of  (E-62)  and  (E-63)  Into  (E-60)  yields  (note  z p^(t)  ■ 0 If 
til)  i 

Kj  ■ -A'K1  - K^A  - KiBR“1BK1  + Q;  1 • 1,...,N;  t i I 

K(T)  • S (E-64) 

p ■ -Np  - r 

p(T)  ■ 0 (E-65) 

where  p Is  a vector  with  elements  and  the  1th  element  of  r Is 

r1  ■ Tr(KWi  <v i v > Wj)  (E-66) 

Equation  (E-61)  has  somewhat  different  properties. 
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APPENDIX  F . 

FLIGHT  TEST  TRAJECTORY  DESIGN  BY  SIMPLIC1AL  PIVOTING 
F-l.  INTRODUCTION 

This  appendix  describes  the  problem  of  weapon  system  flight  test  trajec- 
tory design  for  the  purpose  of  Improving  operational  system  performance 
evaluation.  It  Is  shown  that  the  observability  of  the  principal  reentry 
guidance  system  errors  can  be  substantially  enhanced  by  trajectories 
designed  for  this  purpose.  These  errors  are  evaluated  using  a simulated 
post  flight  analysis  of  the  measurements  made  by  the  reentry  vehicle  In- 
ertial measurement  unit  (RIMU)  and  by  radar/camera  ground  sensors.  The 
result  of  this  evaluation  for  a flight  test  trajectory  Is  the  covariance 
matrix  of  the  error  In  estimating  the  RIMU  error  sources.  The  measure  of 
Improvement  provided  by  a designed  trajectory  Is  a weighted  functional  of 
this  covariance  matrix,  where  the  weight  assigned  to  each  error  source  Is 
Its  contribution  to  the  CEP  of  a candidate  operational  trajectory.  The 
search  for  a reentry  trajectory  which  minimizes  this  functional  and  satis- 
fies energy,  vehicle,  and  Instrumentation  constraints  Is  performed  with  a 
slmpllclal  pivoting  algorithm.  The  problem  Is  solved  for  each  of  two 
RIMUs.  First,  the  Small  Hardened  Inertial  (glmballed)  Platform  (SHIP)  Is 
considered,  and  second,  the  Dormant  (strapdown)  Inertial  Navigation  System 
(DINS),  with  laser  gyros  is  considered.  The  extent  of  SHIP  and  DINS  error 
parameter  estimation  capability  during  a flight  test  Is  derived.  The  results 
show  that  significant  Improvement  In  the  observability  of  SHIP  principal 
error  parameters  can  be  attained. 

The  operational  weapon  system  and  Its  RIMU  principal  performance  contribu- 
tors are  desclrbed  In  Sections  2 and  3 respectively.  The  flight  test 
trajectory  design  problem  to  Improve  error  source  estimation  Is  defined  In 
Section  4.  An  approximate  solution  to  this  problem  Is  sought  by  reducing 
the  number  of  variables  and  applying  a mechanized  algorithm.  Section  5 
discusses  the  selection  of  the  slmpllclal  pivoting  algorithm  to  solve  this 
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reduced  problem.  Section  6 gives  resuts  of  the  trajectory  design  study  by  1 

comparing  the  parameter  estimation  realizable  with  the  designed  trajec-  > 

torles  with  that  from  two  candidate  flight  test  trajectories.  A brief 
summary  Is  given  In  Section  7.  , 
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OPERATIONAL  SYSTEM  DESCRIPTION 
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The  operational  system  considered  consists  of  an  aerodynamlcally  con- 
trolled reentry  vehicle  and  a reentry  Inertial  measurement  unit  (RIMU) 
deployed  from  a Mlnuteman  111  booster  with  a NS-20  guidance  system.  The 
NS-20  Is  modeled  with  the  error  sources  and  error  source  uncertainties 
corresponding  to  current  accuracy  estimates.  The  RIMUs  considered  here 
are  the  SHIP  and  the  DINS  platforms. 

At  launch,  the  RIMU  Is  assumed  coarsely  aligned  In  azimuth  and  Is  aligned 
about  the  level  axes  using  Its  accelerometers.  The  RIMU  navigates  from 
launch  and  Is  updated  by  comparisons  with  the  more  accurate  NS-20. 

The  reentry  navigation  system  Is  Initialized  at  reentry  with  a state 
vector  mapped  from  the  estimated  state  at  deployment  and  navigates  through 
the  reentry  phase  of  the  mission. 

F-2.1  SHIP  Error  Model 

The  SHIP  Is  modeled  with  a total  of  93  accelerometer,  gyro,  glmbal  mass 
unbalances,  and  platform  compliance  errors.  The  SHIP  platform  axes  are 
aligned  to  a downrange,  crossrange,  and  up  orientation  at  launch  and  the 
accelerometer  and  gyro  Input  axes  are  as  shown  In  Figure  F-l. 

Accelerometer  Error  Model 


The  acceleration  error  for  each  accelerometer  Is  modeled  by: 
AAt  - Kq  f KjAi  + Ks  JA1  + KQ\  + KjSlgn^  + KQ) 

* Vi2  ♦ K3V  * Vl\  * K1oA)Ao  * Vo2 

* K21#1  ! A1>  * Kp4p  * Vo  ♦ 8Ap  ♦ yA0 


J 


1 
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X-Accelerometer 

Figure  F-la.  SHIP  Accelerometer  Orientations 


Figure  F-lb.  SHIP  Gyro  Orientations 


The  coefficients  for  the  error  model  and  their  description  are: 


! 
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KQ  - bias 

- scale  factor 

Kg  - absolute  scale  factor 
Kd  - hysteresis  bias  shift 
Kg  - Input  axis  quadratic  nonlinearity 
K3  - cubic  nonlinearity 

- pendulous  cross  axis  scale  factor 
K1(J  - output  cross  axis  scale  factor 
Kg0  - output  axis  quadratic  nonlinearity 
Kg.)  - Input  axis  quadratic  difference 

Kq  - output  cross  axis  bias 
B - Input  axis  toward  pendulous  axis  misalignment 
y - Input  axis  toward  output  axis  misalignment 

and  the  subscripts  (1.  p,  o)  denote  the  Input. pendulous,  and  output  axes  of 
the  accelerometer. 


Gyro  Error  Modal 

The  drift  rate  error  about  the  gyro  Input  axis  Is  modeled  by: 
*1  * * °1A1  + °oAo  * °sAs  * Di1Ai2  * °loA1Ao 

+ °UAIAS  * °ooAo2  * DSS\2  + °osAo\ 


The  coefficients  of  the  gyro  error  model  are: 


0^  - fixed  drift 
Dj  - Input  axis  mass  unbalance 
0Q  - output  axis  mass  unbalance 
D$  - spin  axis  mass  unbalance 
- compliance 
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D^Q  - compl lance 
01s  - compliance 
Dqq  - compliance 
Dss  - compliance 
DQS  - compliance 

where  the  subscripts  (1.  o,  s)  denote  the  Input,  output,  and  spin  axes  of 
the  gyro. 

Glmbal  Mass  Unbalance  Model 


The  glmbal  mass  unbalances  give  rise  to  misalignments  about  the  platform  x, 
y,  and  z axes  of  the  forms; 


Misalignment 
about  x axis 


«xy  * *Kxy  \ 
9XZ  " Kxz  AZ 


Misalignment 
about  y axis 


Kyx  Ax 

" ’Kyr  Az 


Misalignment 
about  z axis 


®zx  " '^zx  Ax 
9zy  " *zy  Ay 


Where  the  A , A , A are  In  platform  coordinates, 
x y z 

Platform  Compliance  Model 


Deformation  of  the  platform  caused  by  g-loadlng  causes  the  accelerometers 
to  be  misaligned  with  respect  to  their  theoretical  Input  axes.  The  errors 
In  acceleration  caused  by  this  deformation  are  modeled  as: 


AA1  " K1jkAjAk 
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AA.|  is  the  acceleration  error  along  the  ith  axis  caused  by  the 
Aj  and  accelerations. 

Platform  Alignment 

The  platform  is  misaligned  at  launch  by  the  angles  $ , $ , * about  the 

a y z 

platform  axes.  The  acceleration  error  due  to  the  platform  misalignment  Is 
given  by 

2S(t)  * 

where  I and  KK  are  In  platform  coordinates. 


F-2.2  DINS  Error  Model 
Coordinate  Systems 

The  orientation  of  the  plate  axes  on  the  RV  Is  given  by 

x ■ roll 
y ■ pitch 
z » yaw 

The  orientation  of  the  DINS  accelerometers  and  gyros  Is  described  in 
Volume  II. 


Accelerometer  Error  Model 

The  DINS  accelerometer  error  model  Is  given  1r  accelerometer  coordinates 
and  Is  applied  to  all  three  accelerometers.  The  acceleration  in  accelero- 
meter coordinates  Is  denoted  by 
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where  the  subscripts  I,  P,  0 refer  to  the  input,  pendulous,  and  output 
axes  which  comprise  the  right-handed  accelerometer  coordinate  system.  The 
angular  rate  about  the  accelerometer  input,  pendulous,  and  output  axes  is 
denoted  by 


W 

w 

w 


I 

p 

0 


The  acceleration  error  along  the  input  axis  is  given  by 


5Aj  ■ Kg  + KjjAj  + KpAp  + KQAg  + KjgAj2  + Kp2Ap2  + Kg2AQ2 


* ^IPAIAP  * ^I0AIA0  * K0PA0AP  * K 1 3 A i + Kft^Ai 


P3  P 


+ KwWlWp 


The  descriptions  of  the  coefficients  for  the  error  model  are: 

K0  - bias 

- scale  factor 

Kp  - pendulous  g sensitivity 
Kq  - output  g sensitivity 
Kjg  - input  quadratic  nonlinearity 
Kpg  - pendulous  quadratic  nonlinearity 
Kq2  - output  quadratic  nonlinearity 
Kjp  - input-pendulous  nonlinearity 
KI0  “ 1 nput-output  nonlinearity 
Kgp  - output-pendulous  nonlinearity 
K13  - Input  cubic  nonlinearity 
Kpg  - pendulous  cubic  nonlinearity 
Kgg  - output  cubic  nonlinearity 
Kw  - anisoinertia 
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Since  DINS  Is  a strapdown  system,  the  accelerometers  measure  acceleration 
In  a coordinate  frame  which  changes  as  the  RV  attitude  changes.  In  order 
to  obtain  the  Inertial  velocity  Increments,  the  sensed  body  velocity 
Increments  must  be  transformed  Into  the  Inertial  coordinate  system.  One 
method  of  doing  this  would  be  to  first  transform  the  velocity  Increment 
from  the  sensor  (accelerometer)  frame  S to  the  body  frame  B by 

« [S  — *B] 

where  the  sensor-to-body  matrix  [S  — ► B]  Is  constant  in  time.  The  Incre- 
mental velocity  In  body  coordinates  could  then  be  transformed  Into  the 
Inertial  system  I by 

A7j  - [B  -*■!]  a7b 

where  the  body-to- Inertial  matrix  [B ■— ► !]  Is  determined  by  the  body 
orientation,  which  In  turn  Is  obtained  from  the  gyro  measurements. 

Gyro  Error  Model 

The  DINS  gyro  error  model  Is  given  In  gyro  coordinates  and  Is  applied  to 
all  three  gyros.  The  acceleration  In  gyro  coordinates  Is  denoted  by 


A * 


where  the  I,  J,  and  K axes  form  a right-handed  coordinate  system.  The 
angular  rate  about  the  gyro  I,  J,  and  K axes  Is  denoted  by 


w ■ 


Each  gyro  is  designed  to  measure  the  rate  about  Its  I axis  (Wj). 
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The  error  In  the  measurement  of  rate  Is  given  by 


5W  * KB  + Krw  t 1/2  + KjWj  + kiaiU1AI  + K IAJW1AJ 


+ kiakwiak+  kjwj  + kkwk  + kjajwjaj  + kkakwkak 


The  descriptions  of  the  coefficients  for  the  error  model  are: 

KB  - fixed  drift 
KRW  " random  drift 
Kj  - scale  factor 

kIAI  ) 

K ( acceleration  sensitive  scale  factor 
KIAK  ' 

Kj  - misalignment  to  J 

K^  - misalignment  to  K 

Kjaj  - acceleration  sensitive  misalignment  to  J 

K^ak  - acceleration  sensitive  misalignment  to  K 

Plate  Error  Model 


Deformation  of  the  plate  by  g-loadlng  causes  the  accelerometers  to  be 
misaligned.  Due  to  a lack  of  physical  test  data,  a simple  bending  model 
relating  the  structural  compliance  of  the  accelerometer  cluster  to  the 
g-loadlng  was  chosen.  This  model  is  the  same  as  the  SHIP  platform  compli- 
ance model . 

F-2 . 3 Candidate  Operational  Trajectory 

The  operational  trajectory  assumed  for  this  analysis  is  the  standard  MM  I II 
-27.5  degree  reentry  angle  accuracy  studies  trajectory  terminated  by  a 
mixture  of  yaw  maneuvers  and  coasts.  The  reentry  trajectory  Is  depicted 
In  Figure  F-2, 
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IDENTIFICATION  OF  PRINCIPAL  PERFORMANCE  CONTRIBUTORS 


The  operational  accuracy  of  a strategic  missile  system  is  calculated  from 
an  error  source  budget  since  the  system  accuracy  cannot  be  measured 
directly  In  an  operational  environment  with  operational  trajectories. 

Thus,  an  error  source  budget  Is  estimated  in  testing  activities  and  the 
system  performance  is  calculated  with  error  analysis  techniques  for  the 
operational  case. 

Therefore,  the  accuracy  of  the  operational  performance  estimate  depends  on 
the  fidelity  of  the  error  source  budget  determined  from  testing  activities 
and  the  sensitivity  of  the  calculated  operational  performance  to  varia- 
tions In  the  error  source  magnitudes.  This  sensitivity  depends  both  on 
the  magnitude  of  the  particular  error  source  value  In  comparison  to  the 
remainder  of  the  error  sources  and  on  the  error  sensitivity  of  the  partic- 
ular source.  For  example,  in  a system  where  the  budget  accuracy  Is 
dominated  by  a single  error  source,  a small  change  In  the  magnitude  of 
that  source  will  cause  significant  change  In  the  calculated  accuracy.  At 
the  same  time  for  one  of  the  smaller  contributions,  even  though  It  might 
have  a large  Individual  error  uncertainty,  the  same  percent  change  will 
have  a much  smaller  effect  on  calculated  accuracy. 

The  criterion  for  selecting  the  principal  performance  contributors  In  this 
analysis  Is  the  sensitivity  of  system  CF.P  to  variations  In  the  error 
source  magnitudes  about  a priori  budget  values. 

The  system  sensitivities  were  evaluated  using  the  Logicon  System  Error 
Analysis  Program  (SEAP)  which  uses  an  extended  Kalman  filter  to  propagate 
system  errors  and  to  simulate  the  system  measurement  updates  of  un  aided 
system.  SEAP  operates  as  shown  In  Figure  F-3  to  evaluate  the  performance 
of  an  optimal  system  mechanization. 


Figure  F-3.  Systea  Error  Analysis  Program 
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F - 3 . 1 SHIP  Principal  Performance  Contributors 

In  the  SHIP  guidance  system  under  consideration,  the  reentry  systems 
errors  consist  ot'  the  navigated  position  and  velocity  plus  the  93  SHIP 
error  sources,  while  the  navigation  aid,  the  NS-20,  Is  modeled  by  78 
error  source  states  in  a filter  state  vector  because  of  correlations  from 
measurement  to  measurement.  The  SEAP  state  vector  Is  shown  In  Figure  F~4. 

The  system  sensitivities  were  calculated  by  perturbing  the  error  source 
magnitude  by  a factor  of  10  (making  the  magnitude  larger)  and  calculating 
the  resulting  change  in  CEP. 

The  system  sensitivities  were  first  evaluated  in  groups  to  eliminate  pos- 
sible error  sources  from  contention.  The  groups  were  formed  based  upon 
the  results  of  linear  error  analyses  of  the  SHIP  over  the  boost  and  re- 
entry phases  of  the  mission.  For  those  groups  not  eliminated,  the  contri- 
buting error  sources  were  determined  using  subdivisions  of  the  groups  and 
finally  individual  system  CEP  sensitivities  were  determined.  For  the  sys- 
tem and  a priori  error  budget  under  consideration,  the  system  sensitivity 
magnitudes  are  dominated  by  13  error  sources.  The  13  error  sources  with 
the  largest  sensitivities  and  their  sensitivities  are  given  In  Table  F-l. 
These  significant  sensitivities  arise  during  the  reentry  phase  since  the 
effects  during  boost  are  estimated  by  the  inflight  measurements.  Error 
sources,  such  as  azimuth  alignment  which  might  be  expected  to  appear  among 
the  largest  contributors  do  not  because  they  are  estimated  by  the  inflight 
measurements. 

F - 3 . 2 DINS  Principal  Performance  Contributors 

In  the  DINS  guidance  system,  the  reentry  system  errors  consist  of  naviga- 
ted position  and  velocity,  initial  misalignment  and  96  DINS  error  sources. 
The  NS-20  errors  are  modeled  as  for  SHIP.  The  SEAP  state  vector  is  as 
shown  in  Figure  F-4  except  for  an  added  random  walk  gyro  drift,  which  is 
modeled  as  described  earlier. 
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Figure  F-4.  Systea  State  Vector 
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Table  F-l.  SHIP  Principal  Performance  Contributors 


Source  Number 


Description 


CEP  Contribution 
(t  of  System  CEP) 


1 Glmbal  Mass  Imbalance  about  Z by  Y 139 

2 Y-Gyro  Dn  95 

3 X-Accelerometer  Dent  to  Y by  Y 84 

4 Z-Gyro  D$s  78 

5 Z-Gyro  0^  56 

6 X-Accel erometer  Bent  to  Y by  X 40 

7 X-Gyro  DJ0  39 

8 Glmbal  Mass  Imbalance  About  X by  Y 35 

9 Y-Gyro  Diq  35 

10  X-Accelerometer  Bent  to  1 by  Z 35 

11  Y-Gyro  Dqo  34 

12  Z-Gyro  0n  27 

13  Z-Gyro  l)QS  27 


*10001.  Increase  In  uncertainty 
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As  with  SHIP,  the  significant  system  error  contributions  of  the  DINS  plat- 
form arise  after  the  boost  phase.  The  principal  DINS  error  contributor 
is  the  gyro  scale  factor  which  causes  a misalignment  at  reentry.  This 
misalignment  is  substantial  because  of  the  many  revolutions  of  the  reentry 
vehicle  during  free  flight.  Thus  a small  gyro  scale  factor  error  will 
produce  a large  misalignment  at  reentry. 

This  misalignment  Is  oriented  principally  along  the  average  direction  of 
the  roll  axis  during  free  flight.  Since  this  direction  Is  approximately 
along  the  roll  axis  at  reentry,  the  effect  on  CEP  at  Impact  is  less  for 
the  trajectories  considered  here  than  If  the  misalignment  were  about  the 
pitch  or  yaw  axes.  Consequently,  the  Initial  pitch  and  yaw  misalignments, 
though  much  smaller  than  the  roll  misalignment,  have  a comparable  miss 
contribution.  The  initial  platform  misalignments  at  reentry  contribute 
96%  of  the  total  DINS  reentry  CEP  for  the  operational  yaw-maneuvering 
trajectory.  Thus,  the  principal  performance  contributors  considered  for 
the  DINS  guidance  system  are  only  the  three  Initial  platform  misalignments 
at  reentry. 


FLIGHT  TEST  REENTRY  TRAJECTORY  DESIGN 
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F-4.1  Flight  Test  System 

The  system  assumed  for  the  flight  test  experiment  Is  the  flight  test  re- 
entry vehicle  deployed  from  a Mlnuteman  I booster  on  a SAMTCC  to  Kwaja- 
lein  trajectory.  For  this  analysis  the  reentry  vehicle  Impact  Is  assumed 
to  be  In  the  lagoon  where  adequate  ground  sensor  coverage  Is  possible. 

The  flight  test  boost  trajectory  has  a -26.7  degree  reentry  angle. 

The  boost  guidance  system  Is  the  NS- 10  guidance  set  and  each  RIMU  Is  a 
less  mature  version  of  the  operational  RIMU.  (Some  of  the  error  source 
magnitudes  are  budgeted  larger  than  those  for  the  operational  version.) 
The  flight  test  RIMU  error  model  form  Is  Identical  to  the  operational 
model  described  earlier.  Except,  the  SHIP  platform  axes  are  In  a down- 
range,  crossrange,  and  down  orientation  at  launch,  and  the  DINS  platform 
axes  are  along  roll,  pitch,  and  yaw  at  reentry. 

A set  of  three  sensors  has  been  chosen.  Figure  F-5  shows  the  locations 
of  the  sensors  and  the  assumed  Impact  point.  The  three  sensors  are  each 
assumed  to  be  a composite  of  a radar  (for  range  measurement)  and  a camera 
(for  angle  measurements)  located  at  the  sites  shown.  Ground  sensor 
measurement  accuracy  Is  assumed  to  be  20  ft  (la  ) In  range  and  0.003° 

(lo  ) in  azimuth  and  elevation.  (In  addition,  the  radars  have  bias  and 
scale  factor  modeled  errors  and  the  cameras  have  bias  errors  for  azimuth 
and  elevation  each  with  the  equivalent  corresponding  lo's  at  a range  of 
100,000  ft.)  The  initial  estimate  of  the  reentry  vehicle  state  at  re- 
entry Is  assumed  to  be  derived  from  this  ground  sensor  data. 

The  assumed  vehicle  Is  a bank-to-turn  vehicle  so  that  the  controls  avail- 
able are  normal  acceleration,  a , and  the  bank  angle,  $ . The  accelera- 
tion due  to  aerodynamic  drag  on  the  vehicle  Is  partially  a function  of 
the  normal  acceleration.  The  vehicle  is  subject  to  contralnts  on  normal 
acceleration  magnitude,  Integral  of  acceleration,  and  Impact  Mach  number. 
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F-4.2  The  Identification  Problem 


The  RIMU  and  ground  sensor  state  error  variables  are  taken  to  be  of  the 
bias  form,  1 .e. 


(0  RIMU 
®SENSQR 


, 0 ■ 0 


where  the  vector  contains  the  RIMU  error  parameters  to  be  Identi- 
fied and  the  vector  contains  the  ground  sensor  non-random  error 
parameters. 


The  measurement  equation  is 

Z { t)  ■ H(t,u)  0 + v(t) 


where 


E<  v(t)  vT(  t*  ))  - R(t)  <5(t  - t*  > 

F-4.2.1  Observability  of  SHIP  Error  Sources 

It  Is  Instructive  to  examine  the  form  of  the  SHIP  errors.  The  SHIP 
error  sources  can  be  divided  into  gyro  and  non-gyro  errors.  In  platform 
coordinates,  the  SHIP  acceleration  errors  can  be  shown  to  be  of  the  fol- 
lowing forms. 

Non-Gyro  Errors 

N1 : &A.j  (t)  * 

N2:  AA1(t)  - 61Ak(t) 

N3:  dAi(t)  « 0iAk(t)AJ_(t) 


F-ZO 


Gyro  Errors 


1 

SKi(t) 

I 

i G3! 

AA^ ( t) 

G3:  AA^t)  ■ 8iy*  Ak(T)At(t)dT  B^(t) 


where  Ak  and  A^  are  the  k and  l components  of  the  acceleration  A and 

0 


B 


*J3  ‘5j2 


•i 


J3 

6j2  1 


5J1 

0 


Is  a misalignment  matrix  corresponding  to  a rotation  about  a predefined  jth 
axis  for  the  1th  error  source. 

If  a velocity  measurement  Is  to  be  made,  the  observable  for  the  1th  SHIP 
error  source  is 

5V,(t)  ■ f AA.|(t)  d-r 


and  for  a position  measurement 

SIT.U) 


f f «i 


(s)  dsdx 


0 0 


The  non-gravl tatlonal  acceleration  In  platform  coordinates  Is  a function  of 
the  normal  acceleration  and  bank  angle  control. 
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At  the  time  of  maneuver  Initiation  on  the  flight  test  trajectory,  the 
vehicle  drag  Is  nearly  along  the  platform  negative  z-axis  and  yaw  maneu- 
vers will  produce  platform  y-acceleratlons  while  pitch  maneuvers  produce 
x-acceleratlons. 

Figure  F-6  depicts  the  non-gravltatlonal  acceleration  In  platform 
coordinates  for  the  flight  test  trajectory  equivalent  to  the  assumed 
operational  trajectory  (a  yaw-maneuvering  trajectory).  For  the  yaw- 
maneuvering  trajectory,  drag  and  the  yaw-accelerations  produce  primarily 
ay  and  az  Inputs  to  the  SHIP  error  dynamics.  It  can  be  seen  that  for 
nine  of  the  error  sources,  Including  the  five  most  important,  little 
separation  In  the  output  channel  can  be  achieved  by  the  yaw-maneuvering 
trajectory.  On  this  trajectory  error  sources  6 and  13  have  virtually  no 
output.  In  contrast,  for  a combined  ax,  a?  (pitching  maneuver),  a three- 
way  channel  separation  can  be  achieved  for  five  of  the  error  sources. 

This  observation,  coupled  with  the  realization  that  a pitch-up  maneuver 
tends  to  extend  flight  time  and  thus  the  number  of  measurements,  suggests 
that  pitching  maneuvers  may  be  advantageous.  It  Is  also  clear  that  more 
output  channel  separation  would  be  achieved  by  the  use  of  maneuvers  which 
Induce  accelerations  along  all  three  platform  axes.  Thus  high  accelera- 
tion and  "zig-zag"  type  maneuvers  are  desirable  for  SHIP  error  source 
observability. 

F-4.2.2  Observability  of  DINS  Error  Sources 

To  enhance  the  observability  of  the  principal  DINS  error  sources,  namely 
the  Initial  platform  misalignments  at  reentry,  by  using  radar/camera 
measurements,  a trajectory  with  a large  dispersion  from  the  ballistic 
Impact  point  Is  desired.  This  can  be  accomplished  by  a large  yaw  maneu- 
ver Iri  one  direction.  Thus  the  DINS  principal  error  sources,  In  con- 
trast to  those  of  SHIP,  are  easily  observable. 
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F-4.3  Input  Design  Techniques 

The  problem  under  Investigation  here  Is  to  Improve  the  Identification  of 
the  RIMl!  error  sources  by  varying  the  test  flight  trajectory,  and  as  such, 
Is  an  Input  design  problem.  This  problem  area  has  been  the  subject  of 
much  statistical  and  engineering  literature.  A common  approach,  which  Is 
somewhat  Independent  of  the  estimator  Invoked,  is  to  use  the  Fisher  Infor- 
mation matrix,  M,  as  a measure  of  the  Information  on  0 provided  by  a feas- 
ible Input.  The  reason  for  Its  use  Is  that  It  Is  computationally  attrac- 
tive and  Its  Inverse,  termed  the  Cramer-Rao  lower  bound,  provides  a "good" 
lower  bound  on  the  covariance  of  8 for  all  regular  unbiased  estimators. 
(Here,  regular  refers  to  certain  modest  regularity  assumptions  on  the  dis- 
tribution of  the  observations,  Rao  (L965).)  The  solution  sought  opti- 
mizes some  objective  functional  of  M or  for  example  a weighted  trace 
or  determinant,  Mehra-Gupta  (1974). 

The  general  problem  considered  In  the  literature  Is  of  the  form 

X » F(t,0)  X + G(t,0)  U ; Y ■ H(t,9)  X + v (F-I) 


where 


X is  the  state  vector 

u Is  the  Input  control  vector 

0 Is  the  vector  of  unknown  parameters 

v Is  a white  noise  vector  with  zero  mean  and  covariance  R. 

Making  use  of  the  additive  type  control,  various  objective  functionals 
can  be  expressed  as 

J(u)  * | < Tu,  u >1 
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where  u belongs  to  some  Hilbert  space  H,  II  u It  <1  and  T Is  some 

normal,  compact  bounded  linear  operator  on  H.  An  optimal  Input  u then 

Is  max  J(u),  which  Is  satisfied  by  the  u corresponding  to  the  largest 
UfH 

eigenvalue  (In  absolute  value)  of  T (see  p.313  of  Rudln  (1973),  Gupta  and 
Hall  (1975)). 

The  problem  considered  here  does  not  fall  Into  the  form  of  ( F- 1 ) since  It 
Is  not  linear  In  the  control  u.  Consequently,  It  cannot  be  solved  by 
applying  the  above  technique.  In  fact,  here  H Is  a function  of  u and  Is 
sufficiently  nonconvex  In  u so  as  not  to  guarantee  convergence  to  an  opti- 
mal Input  of  any  general  optimization  algorithm.  As  a result,  optimiza- 
tion techniques,  based  on  certain  necessary  conditions  for  solution,  are 
used  In  the  present  problem. 

Commonly,  a linear  functional  of  the  Information  matrix  M Is  chosen  for 
the  objective  functional,  since  for  the  general  problem  ( F- 1) , M Is  a 
quadratic  function  of  u.  The  drawback  with  maximization  of  diagonal  ele- 
ments of  M Is  that  the  off-diagonal  elements  can  become  large,  In  which 

_ i 

case  the  diagonal  elements  of  M can  Increase.  This  fact,  In  conjunc- 
tion with  the  nonconvexity  of  H In  u for  the  problem  here  caused  the 
choice  of  a linear  functional  of  the  covariance  matrix  as  the  objective 
functional  to  be  minimized.  This  function  Is  defined  next. 

F-4.4  Trajectory  Performance  Criterion 

The  performance  function  chosen  for  the  trajectory  design  problem  here  Is 
J - tr  (WTWPf)«  WPfWT  » E(we9TWT) 

where  P^  Is  the  final  covariance  of  the  RIMU  error  parameters  after 
estimation. 
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W Is  a row  vector  of  sensitivities  of  the  candidate  operational  system 
error  contributions  with  respect  to  error  source  uncertainty.  Table  F-2 
gives  these  weights  for  SHIP  when  multiplied  by  the  Initial  error  source 
uncertainties  and  normalized  to  1.0.  The  normalized  weights  used  for  the 
Initial  roll,  pitch,  and  yaw  misalignments  of  the  DINS  platform  when  mul- 
tiplied by  their  initial  uncertalnl ties  are  0.5,  0.25,  0.25  respectively. 

F-4.5  The  Trajectory  Design  Problem 

The  flight  test  trajectory  design  problem  formulated  above  Is 

Min  WPfWT 
ucU 


Table  F-2.  SHIP  Performance  Criterion  Weights* 
Error  Source  Weights 


1 

0.192 

2 

0.132 

3 

0.116 

4 

0.108 

5 

0.077 

6 

-0.055 

7 

0.053 

6 

0.048 

9 

-0.048 

10 

0.048 

11 

0.047 

12 

0.038 

13 

0.038 

♦Normalized  to  1.0 
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where 

U Is  the  set  of  autopilot  of  control  commands  satisfying 
vehicle  and  Instrumentation  constraints,  and  yielding 
reentry  trajectories  with  a sufficiently  high  velocity  at 
Impact 

W is  a vector  of  weights  based  on  the  contribution  of  0 to 
the  operational  trajectory  CEP 

Is  the  covariance  of  the  RIMU  error  sources  after  estima- 
tion using  the  measurements 


The  form  of  the  measurement  Is: 

Z(t)  - H(t,u)  5*  ♦ v(t) 

where 

Z(t)  Is  the  difference  between  the  telemetered  RIMU  output 
and  radar/camera  ground  measurements 
H(t,u)  Is  the  matrix  of  sensitivities  to  the  RIMU  and 
radar/camera  error  sources, 

o(t)  is  the  measurement  white  noise  with  covariance  R(t) 


This  problem  Is  a "highly"  nonlinear  optimization  problem  over  the  Banach 
space  of  continuous  control  functions  ucU  and  is  too  unwieldy  to  solve. 
Consequently,  an  approximate  solution  Is  sought.  First,  a finite  dimen- 
sional approximation  to  the  space  of  control  functions  is  defined  by 
considering  only  step  function  control  commands  which  are  defined  over 
the  following  six  time  Intervals. 


19.0  ♦ 22.0  \ 

22.0  - 24.0  I 

24.0  - 26.0  f 

26.0  - 28.0 

28.0  -*•  30.5  ] 
30.5  34.5  / 
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The  control  commands  are  specified  as  a normal  acceleration  and  a bank 
angle  during  each  time  Interval.  So,  the  allowable  control  command  space 
has  been  reduced  to  a twelve  dimensional  euclidean  space.  Second,  In 
order  to  decrease  the  cost  of  the  reevaluation  of  P^..,  the  number  of  error 
sources  considered  is  decreased  from  the  full  model  to  the  principal 
operational  error  sources  plus  the  three  Initial  misalignments.  Third, 
an  efficient  reentry  trajectory  generator  was  developed  to  approximate 
the  more  costly  complete  3 DOF  flight  test  trajectory  simulator. 

This  reduced  trajectory  design  problem  Is  still  a highly  nonlinear  con- 
strained optimization  problem,  but  the  number  of  variables  have  been  dra- 
matically cut  to  make  the  problem  manageable. 

The  procedure  herein  is  to  apply  the  simpllclal  pivoting  algorithm  to 
the  reduced  trajectory  design  problem  for  SHIP  and  for  DINS  and  then 
determine  the  Improvement  of  this  designed  trajectory  over  two  current 
candidate  flight  test  trajectories  using  the  full  model  estimator  and 
trajectory  generator. 
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F-5.  THE  SIMPLICIAL  PIVOTING  ALGORITHM 

In  this  section  the  rational  behind  the  selection  of  the  simp  1 1 cl al  pivot- 
ing algorithm  to  solve  the  reduced  trajectory  design  problem  Is  given  and 
the  development  of  the  algorithm  to  the  problem  Is  described.  The 
rational  used  here  Is  the  same  as  Mould  be  used  In  attacking  a variety  of 
optimization  problems. 

F-5.1  Selection  of  an  Optimization  Algorithm 

The  methods  available  tb  solve  constralnted  optimization  algorithms  can 
be  classified  Into  gradient-type  and  direct-search  methods.  The  charac- 
teristics of  the  problem  at  hand  are  used  to  determine  the  appropriate 
type  of  algorithm  to  apply. 

F-S.l.l  The  Two  Classes  of  Algorithms 

Gradient-type  algorithms  are  those  which  require  the  use  of  a derivative, 
or  an  Increasingly  accurate  "approximate"  derivative,  of  the  objective  or 
constraint  functionals.  These  algorithms  require  more  computations  per 
Iteration  than  the  direct-search  algorithms,  but  for  "well-behaved"  prob- 
lems they  have  a faster  convergence  rate  as  well  as  conditions  for 
"optimality"  of  the  solution.  Gradient-type  algorithms  are  divided  Into 
two  classes  • those  which  solve  a sequence  of  uncontralned  problems 
formed  by  adding  a sequence  of  penalty  functions  and  those  which  generate 
a sequence  of  feasible-descent  steps. 

Penalty  functions  are  added  to  the  objective  functional  or  to  the  lagranglan 
of  the  problem  In  an  effort  to  Increasingly  penalize  candidate  solutions 
which  are  near  the  constraints  or  Infeasible.  Feasible-descent  directions 
are  commonly  generated  by  using  a minimum  norm  projection  onto  the  feasible 
set  of  a descent  direction  such  as  -"TJ  or  In  the  case  of  non- 

linear constraints  the  projection  Is  frequently  performed  onto  the  Inter- 
section of  the  tangent  hyperplanes  of  the  "« -active"  constraints  at  the 
point. 
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In  many  optimization  problems  analytical  derivatives  are  not  available 
and  finite  difference  approximations  involve  excessive  computational 
cost.  Consequently,  direct-search  algorithms  based  only  on  the  values  of 
the  objective  functional  and  the  constraints  have  been  widely  used. 

These  algorithms  are  easy  to  Implement  and  are  applicable  to  a broad 
class  of  problems.  They  are  aimed  at  finding  “good"  solutions  since  opti- 
mality conditions  are  usually  sacrificed  for  Improved  efficiency.  Though 
the  rate  of  convergence  is  generally  slower  than  for  a gradient-type 
method,  the  lower  computational  cost  per  Iteration,  which  Is  Indicative 
of  direct-search  methods,  provides  for  better  overall  efficiency  In  many 
problems. 


F-5.1.2  Trajectory  Oeslgn  Problem  Characteristics 

The  choice  of  the  type  of  algorithm  to  use  depends  on  the  properties  of 
the  problem  at  hand. 

The  characteristics  of  the  reduced  trajectory  design  problem  which  are 
Important  In  algorithm  selection  are  the  following: 

\)  The  objective  functional  Jr(u)  and  the  trajectory  con- 
straints are  "highly"  nonlinear  In  the  trajectory  control 
variable  u. 

2)  The  gradients  of  Jr(u)  are  costly  to  compute. 

31  Due  to  Inflight  perturbations  In  the  commanded  trajectory 
a "precise"  solution  Is  not  necessary. 

4)  The  dominant  cost  of  solution  Is  the  functional  evaluation 
of  Jr(u). 

5)  The  trajectory  control  solution  space  Is  twelve  dimen- 
sional euclidean  space. 

Properties  1,  2,  and  3 of  this  problem  indicate  that  a direct-search 
algorithm  will  perform  better  here  than  a gradient-type  algorithm. 
Properties  4 and  5 will  help  In  determining  which  type  of  direct-search 
algorithm  to  choose. 
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F-5.1,3  D1 rect-Search  Algorithms 

The  first  type  of  direct-search  algorithm  to  be  considered  Is  the  method 
of  local  variations,  see  Banltchouk  (1966).  This  method  is  based  on  a 

V 

progressively  finer  partitioning  of  the  feasible  set.  From  x the  algo- 

K k k 

rlthm  samples  adjacent  vertices  of  the  partition,  x + , until  for 

1 ■ j,  J(xK  + ojKPjl<)  < 0(xK).  Then  xK+1  ■ xK  + ^Pj*.  When  such  an 
Improvement  Is  no  longer  possible,  thea^'s  are  reduced  (i.e.,  the  mesh 
of  the  partition  Is  reduced)  and  the  algorithm  pivots  on  a finer  partition 
(see  Figure  F-7  for  an  example).  For  the  unconstrained  problem,  the  accu- 

| V ) 

mulatlon  points  x*  of  these  jx  | are  shown,  under  reasonable  assumptions, 
to  satisfy  vT(x*)  ■ 0. 

The  standard  partition  Is  an  orthogonal  one,  but,  If  possible,  It  Is 
better  to  choose  a partition  where  there  are  P^'s  along  the  constraint 
boundaries.  When  the  constraints  are  nonlinear  a penalty  function  tech- 
nique should  be  added.  The  purpose  of  this  Is  to  help  avoid  a "jamming" 
of  the  algorithm  at  a boundary  point  which  Is  not  near  a solution. 

The  DSC  method  (see  Swann  (1972))  Is  like  the  above  method  except  that 
mutually  orthogonal  search  directions  are  rotated  according  to  the  prog- 
ress made  after  trying  all  the  search  directions.  For  example,  In  the 
case  of  a linear  constraint  violation,  the  boundary  point  Is  estimated 
and  the  normal  to  the  constraint  Is  taken  as  one  of  the  search  directions 
with  the  others  chosen  orthogonal  to  It.  (This  Is  usually  called  self- 
boundlng.)  Such  methods  which  change  the  search  directions  sacrifice  the 
partitioning  and  the  corresponding  convergence  proof  of  local  variations 
for  a more  efficient  boundary  following  search  scheme.  Since  there  Is  no 
longer  a partition  to  ensure  no  cycling,  the  DSC  method  uses  a single- 
step  parameter  for  Its  search  and  It  Is  reduced  when  It  Is  greater  than 
the  total  progress  made  after  a full  cycle  of  search  directions. 

A simpler  approach  Is  a Monte  Carlo  method  (see  Luus  and  Jaakola  (1973)) 
where  m search  directions  are  selected  at  random.  The  algorithm  pivots 
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to  the  best  feasible  of  these  and  then  a new  set  of  reduced  size  Is 
again  selected  at  random.  This  method,  however,  seems  to  require  an 
excessive  number  of  function  evaluations. 

Powell's  (1964)  conjugate  direction  method  searches  on  a set  of  directions 
which  are  updated  each  Iteration  using  the  total  progress  vector  P,  only 
If  exchanging  It  with  a current  search  direction  increases  the  value  of 

0 which  Is  characteristic  of  a conjugate  direction  with  respect  to  a quad- 
ratic approximation  of  J.  Namely,  If  J ■ 1/2  xTHx  + aTx  and  If  the  search 
directions  <P^:  1 ■ l,...,n)  satisfy  l/2P^HPj  • 1,  then  the  determinant, 

4,  of  the  matrix  P composed  of  P^'s  takes  Its  maximum  when  the  P^  are 
mutually  conjugate  (i.e.,  P^THPj  ■ 0).  Simple  tests  can  be  derived  to 
determine  which  P^  to  replace  by  P for  maximum  Increase  In  A.  The  genera- 
tion of  the  search  directions  P^  Is  based  on  n-dlmenslonal  minimizations 
and  the  following  easily-derived  fact. 

If  the  minimum  of  a quadratic  J In  a direction  P from  y.  Is  at  x^  for 

1 • 1,2  then  x2  - x^  Is  a conjugate  direction  to  P.  A basic  Iteration 
for  an  Initial  guess  xQ  and  ( P^ , . . -Pn)  Is 

1)  Define  x^  ■ where  minimizes  f(x^  + ^p-j ) 

for  1 ■ 

2)  Define  P^  ■ P^  + 1,  pn  “ xn  ' *q»  and  repine  Xq  by  x^  + aPn. 

The  purpose  of  evaluating  A Is  to  help  avoid  the  directions  P^  from  becom- 
ing linearly  dependent.  A simpler  way  to  avoid  this  is  to  reinitialize 
every  n+1  Iterations. 

A method  which  does  not  require  the  1-dlmenslonal  minimizations  as  des- 
cribed above  Is  the  pattern  search  method  (see  Hooke  and  Jeeves  (19611). 
This  method  searches  from  x*  along  x*  - x*"*  a distance  II  x-xK-1  II  to 
obtain  a point  y*,  from  which  n-lteratlons  of  a local  variation-type  plvot- 
Ing  Is  performed  to  obtain  x.  *.  An  example  Is  shown  in  Figure  F-8  for 
n ■ 2. 
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There  are  many  constraint-following  schemes  (see  Glass  and  Cooper  (l%bl) 
the  purposes  of  which  are  to  avoid  “jamnliuj."  Some  ot  these  Include: 
searching  along  a pattern  direction  as  long  as  there  Is  Improvement, 
local  variations  along  tangent  hyperplanes  to  active  constraints,  and 
gradient  projection  techniques. 

K 

The  probes  y are  allowed  to  be  nonfeaslble  In  the  hope  that  local  varia- 
tions pivoting  will  produce  a feasible  point,  If  not,  local  variations 

K 

are  performed  around  x . If  these  variations  fall  the  step  size  Is 
reduced.  As  an  additional  aid,  penalty  functions  have  been  used  as  des- 
cribed earlier.  Nevertheless,  in  higher  dimensional  problems,  pattern 
search  Is  not  as  effective  In  determlng  appropriate  pattern  directions 
and  seems  to  be  more  prone  to  "Jamming." 

Some  of  the  methods  which  are  more  flexible  In  selecting  search  direc- 
tions are  the  slmpllclal  pivoting  methods  (see  Spendley,  Hext,  and 
Himsworth  (1962),  Box  (1965),  and  Keefer  (1973)). 

To  approximate  solutions  to  minimization  problems  on  an  n-dlmenslon 
euclidean  space,  Rn,  slmpllclal  pivoting  algorithms  store  the  value  of 
the  objective  functional,  J,  at  n+1  points  (V^  : 1,  ....  n + 1). 

Pivoting  from  these  points  Is  accomplished  by  dropping  the  point  Yj  with 
the  largest  value  of  J and  adding  the  point  V’j  obtained  by  reflecting 
Vj  through  the  centroid,  c,  of  the  remaining  points.  Namely, 

vj  - 2c  - Vj 


where 


r 

LOGICON 

The  convex  hull  of  IV^  ; 1 =■  1,  n + 1}  forms  a closed  n-simplex. 

The  simp  1 1 ci al  pivoting  just  defined  is  depicted  for  n=2  in  Figure  F-9. 

In  the  algorithm  this  pivoting  continues  until  VJ  is  infeasible  or  J(VJ) 

Is  also  the  largest  value  of  J when  compared  with  the  other  vertices  of 
the  n-simplex.  When  this  occurs  a new  vertex  is  generated  by  reflecting 
Vj  through  the  vertex  with  the  best  value  of  J,  namely  V j 1 • 2V^  - Vj. 

If  J ( Vj ' ) Is  again  the  largest,  then  Vj  is  dropped  and  simpliclal  pivot- 
ing Is  performed  on  the  remaining  n-1-slmplex.  The  purpose  of  this  Is  to 
cause  the  algorithm  to  follow  the  valley  or  constraint  which  Is  assumed  to 
be  approximately  orthogonal  to  VJ  - Vj. 

To  help  avoid  "Jamm1ng"on  the  constraint  boundaries  a penalty  function  is 
added  to  the  objective  functional  which  increasingly  penalizes  points 
near  the  constraints.  The  penalty  function  is  chosen  so  as  to  form  a 
valley  between  the  constraints  on  Che  interior  which  the  algorithm  can 
follow.  To  aid  In  this  and  thereby  Increase  the  rate  of  convergence, 
mesh  expansion  logic  can  be  included  to  increase  the  size  of  the  pivoting 
steps  along  directions  "locally"  parallel  to  the  contraints. 

F-5.1.4  A Comparison  of  Direct-Search  Algorithms 


| The  direct-search  algorithm  to  be  applied  to  the  reduced  trajectory 

! design  problem  Is  chosen  based  on  the  characteristics  of  the  problem. 

! The  Monte  Carlo  method  Is  ruled  out  since  information  on  previously  eval- 

i uated  trajectories  should  be  used  to  aid  in  selecting  a new  trajectory  in 

i order  to  cut  down  on  the  prohibitive  cost  of  trying  to  cover  the  space  of 

| feasible  trajectories.  Also,  the  conjugate  directions  method  does  not 

i seem  appropriate  due  to  the  nonquadratic  nature  of  J and  the  cost  of 

j 1-dlmensioned  minimizations. 

| The  methods  of  local  variations,  pattern  search  and  simplicial  pivoting 

\ can  be  compared  on  the  basis  of  the  amount  of  memory  of  previously  evalu- 

ated trajectories  that  each  possesses.  The  method  of  local  variations 

i 

r 
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and  pattern  search  have  1 and  2 point  memories  respectively.  Whereas, 
simplicial  pivoting  has  a n+1  point  memory  where  n here  is  twelve.  Due 
to  the  dominant  cost  of  functional  evaluation,  the  relative  cost  of  this 
memory  Is  negligible.  Thus,  since  the  simplicial  pivoting  method  pro- 
vides a better  current  local  approximation  of  J(u)  without  noticable  addi- 
tional cost,  It  should  better  select  a new  pivoting  direction  in  which  to 
proceed.  Also,  the  Improvement  techniques  (l.e.  penalty  functions,  con- 
straint following,  and  mesh  variation)  of  local  variations  and  pattern 
search  have  their  counterparts  In  the  simplicial  pivoting  algorithm. 
Consequently,  a simplicial  pivoting  algorithm  was  selected  to  be  applied 
to  the  reduced  trajectory  design  problem. 

F-5.2  The  Simplicial  Pivoting  Algorithm 


In  this  section  the  application  of  the  simplicial  pivoting  algorithm  to 
the  reduced  trajectory  design  problem  is  described.  The  pivoting  is  per- 
formed with  twelve  dimensional  slmplicies  where  each  dimension  represents 
a commanded  normal  acceleration  or  bank  angle  over  one  of  the  six  trajec- 
tory time  intervals  specified  above.  The  initial  simplex  Is  generated 
using  a method  of  local  variations  from  the  starting  trajectory  comprised 
of  10%  max  g's  changes  in  the  yaw  commands  and  5%  max  g's  changes  in  the 
pitch  commands.  The  objective  functional  Jr  was  evaluated  for  each  of 
the  thirteen  verticies  and  a penalty  function  based  on  the  velocity  at 
Impact  was  added  to  each  Jr<  More  precisely  the  total  cost  Cr  for  the 
trajectory  specified  at  each  vertex  was  evaluated  as  follows: 

Cp(  1 ) • [1  + 1G/(V(1)  - VB)]  Jp(1) 


where 

V( 1 ) Is  the  velocity  at  Impact  of  the  ith  vertex 
and  V(1)  > VB  + 10. 

Vg  Is  the  smallest  allowable  velocity  at  Impact  in  ft/sec 
If  V(1)  < VQ  + 10  then  Cr(1)  is  assigned  a large  number. 
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The  vertex  Vj  of  the  simplex  with  the  largest  Cr  Is  dropped.  If  this 
vertex  Is  an  allowable  trajectory  a new  vertex  Is  added  by  reflecting  it 
through  the  centroid,  C,  (l.e.,  center  of  mass)  of  the  remaining  vertices. 
Namely,  the  new  vertex,  VJ,  Is  C+(C-Vj).  On  the  other  hand,  when  Vj  Is 
not  an  allowable  trajectory  or  It  was  the  last  to  be  added,  It  is  replaced 
first  by  the  reflection  of  It  through  the  vertex  with  the  smallest  Cr  with 
the  step  cut  In  half.  Namely,  VJ  ■ Vk  + l/2(Vk-Vj).  If  this  last  replace 
ment  VJ  Is  not  an  allowable  trajectory  then  It  is  dropped  and  pivoting  Is 
resumed  on  the  remaining  simplex  of  one  lower  dimension. 

Mesh  expansion  Is  Incorporated  whenever  the  newly  added  vertex,  VJ,  has 
the  smallest  Cr  and  the  decrease  In  the  velocity  at  Impact  Is  not  too 
large.  Namely,  VJ  * C ♦ 2(C-Vj)  whenever  VI Vj) V(VJ)  < V(VJ)  - 
(Vg+IQO)  where  V( VJ ) Is  the  velocity  at  Impact  of  the  trajectory  VJ. 

These  mesh  reduction  and  expansion  schemes  help,  respectively,  to  flat- 
ten the  simplex  along  directions  which  cause  V(i)  to  decrease  too  rapidly 
and  lengthen  the  simplex  along  directions  which  Improve  Cr ( 1 ) while  not 
decreasing  V(1)  too  rapidly. 

T 

In  addition  to  computing  the  performance  criteria  ■ WPW  , the  algorithm 

13  r 

also  computes  the  weighted  trace  Tr  as  4 measure  of  per- 

l-1 

formance  Independent  of  any  correlations  set  up  between  the  error  sources. 
When  desired,  the  algorithm  will  optimize  with  respect  to  instead  of  Jp 
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In  this  section  the  performance  of  the  estimation  of  the  principal  RIMU 
error  sources,  after  comparing  RIMU  data  and  radar/camera  ground  sensor 
data,  Is  described  for  various  simulated  flight  test  trajectories.  Re- 
sults are  presented  for  SHIP  and  for  OIKS.  The  estimator  used  In  this 
analysis  Is  a version  of  the  USAF/ABRES  post-flight  data  reduction  Ex- 
tended Kalman  Filter  estimator  operating  In  a covariance-only  mode  so  that 
synthetic  data  Is  not  required.  Estimation  performance  Is  first  evaluated 
for  the  principal  error  model  state  used  In  the  reduced  trajectory  design 
problem  and  then  for  the  full  error  model  state.  The  measure  of  perform- 
ance used  Is  the  trajectory  performance  criterion  J • WP^WT  defined  earlier. 

13 

In  addition  the  value  of  the  weighted  trace  T ■ wi2pn  ij  given  for 

W 

each  trajectory  as  an  alternate  measure  of  performance  which  disregards 
correlations. 

F-6. 1 SHIP  Parameter  Estimation  Performance 

The  results  of  the  SHIP  flight  test  trajectory  design  for  the  purpose  of 
Improving  the  estimation  ot  the  principal  performance  contributors  are 
presented  In  two  parts.  First,  the  trajectories  designed  by  the  s 1 trip  1 1 - 
dal  pivoting  algorithm  using  the  16  state  reduced  order  model  are  com- 
pared with  the  two  candidate  flight  test  trajectories.  Second,  the  full 
SHIP  and  radar/camera  error  models  are  applied  to  determine  the  error 
source  parameter  estimation  performance  of  each  trajectory.  The  results 
show  a designed  trajectory  with  661  and  781  Improvement  In  the  full  model 
weighted  performance  criterion  over  the  two  candidate  flight  test  trajec- 
tories, respectively. 
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F-6.1.1  SHIP  Trajectory  Design  Results 

This  section  gives  the  results  of  applying  the  slmpllclal  pivoting 
algorithm  to  the  reduced  trajectory  design  problem.  The  algorithm  was 
Initiated  from  the  operational  yaw  maneuvering  trajectory,  on  which  the 
performance  weightings  are  based,  the  two  candidate  AMaRY  flight  test  tra- 
jectories, and  a ballistic  trajectory.  The  commanded  normal  acceleration 
and  bank  angles  as  a function  time  for  these  trajectories  are  given  In 
Tables  F-3,  F-4,  and  F-5.  Forty  slmpllclal  pivots  were  made  from  each  of 
these  trajectories.  The  performance  results  using  the  16  state  vector  are 
summarized  In  Table  F-6.  Tables  F-7,  F-8,  F-9,  and  F- 10  give  the  result- 
ing designed  trajectories  from  the  slmpllclal  pivoting  algorithm. 

Of  the  four  Initial  slmpllclal  pivoting  results, the  trajectory  designed 
from  the  candidate  operational  yaw  maneuvering  trajectory  performed  the 
best.  Consequently,  the  algorithm  was  applied  from  this  trajectory  two 
more  times  at  40  pivots  each.  The  first  application  yielded  a trajectory 
with  a Jr  • 0.035  and  the  next  application  yielded  the  trajectory  called 
Design  A,  described  In  Table  F-ll,  with  a « 0.01B  and  a Tf  ■ 0.80.  To 
check  for  an  approximate  local  solution  the  algorithm  was  applied  again 
for  40  steps  from  this  Design  A trajectory.  The  resulting  Design  B tra- 
jectory defined  In  Table  F- 12  had  0r  ■ 0.016  and  Tr  ■ 0.80.  Since  the 
additional  Improvement  In  Jp  was  minimal,  the  minimization  was  stopped 
here  with  a 97%  Improvement  of  Jp  over  the  yaw  maneuvering  trajectory. 

Next,  the  slmpllclal  pivoting  algorithm  was  applied  to  the  minimization 
of  the  weighted  trace  Tp  for  the  reduced  trajectory  design  problem  which 
was  defined  above.  As  expected,  the  Improvement  In  Tp  Is  not  as  dramatic 
as  that  for  Jp  since  correlations  set  up  In  the  measurements  do  not  affect 
the  value  of  T„.  The  minimization  of  T„  was  Initiated  at  the  Design  A 
trajectory.  The  resulting  trajectory  after  forty  pivots  is  described  In 
Table  F- 13  and  has  Tp  ■ 0.76.  This  trajectory  Is  similar  to  the  Design  A 
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T (seconds) 

A {%  maximum) 

♦iflsal 

17.7 

67 

90 

20.4 

0 

90 

24. S 

100 

90 

26.0 

100 

-90 

28.  S 

0 

•90 

Table  F-4. 

Flight  Test  Trajectory  #1 

T (seconds) 

A (%  maximum) 

$(deq) 

19.8 

67 

90 

24.8 

0 

-75 

26.8 

67 

-75 

29.8 

0 

180 

31.8 

67 

180 

33.9 

0 

180 

Table  F-5. 

Flight  Test  Trajectory  #2 

T (seconds) 

A U maximum) 

4>(deg) 

17.8 

47 

180 

21.3 

0 

0 

26.3 

100 

0 

27.6 

0 

90 

28.5 

100 

90 

30. 

6? 

180 
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Table  F-6.,  Jr  SHIP  Optimization  Results  After  40  Steps 


Initial  After  40  Pivots 


Jr 


Yaw  Maneuvering 

0,525 

Flight  Test  #1 

0.85 

Flight  Test  #2 

0.60 

Ballistic 

2.22 

Jr 

Jr 

Tr 

1.07 

0.103 

0.875 

1.15 

0.44 

0.86 

1.52 

0.256 

1.24 

2.24 

0.17 

1.07 

Trajectory  Designed  With  Initialization 

at  Yaw-Maneuvering 

T (seconds! 

A (X  maximum) 

i 

18.0 

13 

61 

20.5 

11 

-45.6 

22.0 

20 

-39 

24.0 

100 

91 

26.0 

97 

-98 

28.0 

38 

-153 

29.0 

43 

128  } 

30.5 

27 

76.5  1 

34.5 

0 

76.5 
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Table  F-8.  Trajectory  Designed  from  Flight  Test  #1 


T (seconds) 

A {%  maximum) 

19.0 

23 

83.6 

22.0 

31 

87.5 

23.0. 

61 

90.3 

2S.S 

7 

-81 

27.0 

97 

-86.8 

30.0 

25 

97 

32.0 

74 

159 

34.0 

0 

140 

lie  F-9.  Trajectory  Designed  from 

Flight  Test  i 

T (seconds) 

A (%  maximum) 

d(deo) 

18.0 

15 

176 

20.0 

37 

178 

21.5 

10 

-33.8 

24.0 

11 

5.6 

26.0 

100 

93.6 

30.  Q 

67 

176.5 

Table  F-10.  Trajectory  Designed  from  Ballistic  Trajectory 

T (seconds) 

A (%  maximum) 

$(deq) 

19. 

0.9 

3 

22 

75. 

- 60 

24 

67. 

90 

26 

50. 

100 

28 

33. 

-112 

30.5 

11. 

96.6 

34.5 

0. 

96.6 
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Table  F-ll.  SHIP  Design  A Trajectory 


T (seconds) 

A (4  maximum) 

't(deg) 

19 

4 

-53 

22 

31 

-34 

24 

100 

98.3 

26 

100 

-96 

28 

94 

133 

30. 5 

6 

91 

34.5 

0 

180 

Table  F-12. 

SHIP  Design  B Trajectory 

T (seconds) 

A (f  maximum) 

lUiil 

19 

5 

-42.6 

22 

36 

-35.2 

24 

100 

96.4 

26 

100 

-93.8 

28 

100 

138.2 

30.5 

26 

92.9 

34.5 

0 

76. 

Table  F-13. 

Trajectory  Design  Using  Tr 

T (seconds) 

A (4  maximum) 

'P(deq) 

19 

10 

-63 

22 

30 

-26 

24 

97 

101.5 

26 

99 

-96 

28 

100 

129 

30.5 

23 

90.2 
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trajectory  and,  as  will  be  seen,  its  performance  with  the  full  error  model 
is  expected  to  be  nearly  the  same  as  that  for  the  Design  A trajectory. 

The  reason  for  this  is  the  significant  degradation  in  the  final  covari- 
ance Pf  of  the  significant  error  sources  caused  when  the  error  sources 
neglected  in  the  reduced  design  problem  are  added.  The  extent  of  this 
degradation  from  the  97%  and  29%  improvements  in  0r  and  Tr  respectively 
for  the  reduced  design  problem  will  be  described  next. 

F-6.1.2  SHIP  Parameter  Estimation  Results 

In  this  section  the  SHIP  parameter  estimation  performance  using  the  full 
filter  model  is  determined  for  the  yaw  maneuvering  trajectory,  the  two 
candidate  flight  test  trajectories,  and  for  the  Design  A and  Design  B 
trajectories  described  above.  Each  reentry  trajectory  Is  simulated  with 
a detailed  3 DOF  AMaRV  vehicle  simulator  ini tiali red  wl th  the  nominal 
flight  test  reentry  state.  The  full  filter  state  vector  Includes  90  RIMU 
error  sources,  12  ground  sensor  error  sources,  and  9 states  for  initial 
position,  velocity,  and  misalignment.  The  full  state  estimator  results 
measured  in  terms  of  J and  T are  given  in  Table  F-14.  A comparison  of  the 
improvement  In  the  SHIP  principal  performance  parameter  lo‘s  for  the  tra- 
jectories is  summarized  in  Table  F-IS.  In  terms  of  the  trajectory  perform- 
ance criterion  0,  the  Design  A trajectory  represents  a 49%  improvement  in 
the  yaw-maneuvering  trajectory  and  a 66%  and  78%  Improvement  In  the  flight 
test  #1  and  *2  trajectories  respectively. 

Table  F-14.  Full  State  Estimator  Results 


J 

T 

Velocity  at  Impact 
(%  of  Minimum) 

Yaw  Maneuvering 

0.731 

1.40 

132 

Flight  Test  fl 

1.11 

1.62 

137 

Flight  Test  *2 

1.70 

2.04 

1S2 

Design  A 

0.37b 

1.27 

116 

Design  0 

0.394 

1.26 

112 
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Table  F-15.  SHIP  Principal  Parameter  Estimation 


Percent  change  In  la  Values  from  initial  values 


Error  Source 

Yaw  Maneuvering 

AMaRV  #1 

AMaRV  *2 

Design  A 

Desiqn  8 

1 

19.0 

13.7 

6.3 

34.2 

34.3 

2 

47.0 

26.2 

3.8 

34.4 

32.5 

3 

6.3 

5.1 

1.7 

9.0 

8.6 

4 

30.5 

22.0 

2.2 

28.7 

29.8 

5 

16.5 

21.5 

13.2 

16.5 

17.7 

6 

4.6 

6.2 

4.1 

8.9 

10.1 

7 

51.6 

23.8 

1.9 

32.4 

27.2 

8 

38.3 

27.1 

7.2 

46.8 

45.3 

9 

2.4 

4.2 

3.3 

2,9 

2.7 

10 

3.5 

5.5 

6.3 

5.9 

7.3 

11 

6.0 

6.2 

12.4 

7.3 

10.1 

12 

3.4 

5.3 

7.9 

5.0 

4.3 

13 

2.7 

11. 1 

0.6 

6.8 

4.7 

♦x 

57.0 

57.5 

66.0 

46.5 

48.5 

33.6 

36,3 

69.1 

52.4 

54.5 

♦ 

34.0 

47.0 

58.8 

51.4 

54.1 
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F-6.2  DINS  Parameter  Estimation  Performance 


The  results  of  the  DINS  flight  test  design  for  Improving  principal  para- 
meter estimation  performance  are  presented  in  two  parts.  First,  the 
trajectory  design  by  the  slmpllcial  pivoting  algorithm  using  the  three 
state  reduced  order  model  is  compared  with  the  two  candidate  flight  test 
trajectories.  Second,  the  full  DINS  and  radar/camera  error  models  are 
applied  to  determine  the  error  source  parameter  estimation  performance 
of  each  trajectory.  The  results  show  a 49%  and  an  80%  Improvement  in 
the  performance  criterion  over  the  flight  test  #1  and  #2  trajectories, 
respectively. 

F-6.2. 1 DINS  Trajectory  Design  Results 

The  slmpllcial  pivoting  algorithm  was  applied  to  the  DINS  trajectory  de- 
sign problem  with  the  reduced  model  consisting  of  the  Initial  misalign- 
ments. The  algorithm  was  started  with  the  ballistic  trajectory.  After 
forty  pivots  the  trajectory  performance  criterion,  J,  was  reduced  to 
0.096  with  a 1 directional  yaw-type  trajectory.  From  here  forty  more 
pivots  were  made  to  decrease  J to  0.066.  The  resulting  DINS  design  tra- 
jectory Is  described  In  Table  F-16 . A value  of  J and  the  weighted  trace 
T for  this  designed  trajectory  and  the  other  selected  trajectories  are 
compared  In  Table  F-17.  No  further  minimization  of  J was  performed  be- 
cause the  misalignments  are  very  observable  with  almost  all  non-ball istlc 
trajectories  The  degree  with  which  the  observability  varies  is  depicted 
in  the  following  section  for  the  above  trajectories. 

F-6.2. 2 DINS  Parameter  Estimation  Results 

The  full  110  state  DINS  error  model,  the  twelve  radar/camera  error  states, 
and  a detailed  3 DOF  trajectory  simulation  were  used  to  drive  the  Kalman 
filter  which  determined  the  parameter  estimation  performance.  The  values 
of  the  velocity  at  impact,  the  performance  criterion  0,  and  the  weighted 
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Table  F-16.  DINS  Design  Trajectory 


T (seconds)  A (%  maximum)  4>Ueq) 


19. 

25. 

65. 

22. 

59. 

57. 

24. 

32. 

76. 

26. 

37. 

134. 

28. 

35. 

91. 

30.5 

64. 

93. 

34.5 

0. 

96. 

Table  F-17.  DINS  Reduced  State  Trajectory  Design  Performance 


Yaw 

Maneuvering 

Ballistic 

Fllqht  Test  #1 

Fllqht  Test  #2 

DINS 

Design 

0.096 

795. 

0.24 

0.76 

0.066 

0.099 

906. 

0.16 

0.33 

0.037 

! 

\ 

i 

f 

P 

I 


1 


i 

1 


i 

.1 

i 

j 

j 

'j 

j 


1 


i 
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trace  of  the  covariance  matrix  of  the  error  at  impact  for  the  selected 
trajectories  are  given  In  Table  F-18.  A comparison  of  the  accuracy  of  the 
0 INS  platform  misalignment  estimates  derived  for  each  trajectory  using  the 
full  model  Is  given  In  Table  F-19.  As  a result,  DINS  design  trajectory 
exhibits  a 49%  and  80%  improvement  in  J over  the  flight  test  #1  and  #2 
trajectories,  respectively. 
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Table  F-18.  DINS  Full  State  Estimator  Results 
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F-7.  SUMMARY 

An  approach  to  the  design  of  flight  test  trajectories  for  the  observation 
of  R1MU  guidance  system  errors  has  been  formulated.  The  approach  entailed 
a determination  of  the  principal  operational  performance  contributors  and 
the  design  of  a flight  test  trajectory  to  Increase  the  observability  of 
these  principal  error  sources.  A slmpllclal  pivoting  algorithm  has  been 
developed  to  perform  this  and  trajectories  have  been  designed  with  SHIP 
and  with  DINS  as  the  RIMU.  The  results  show  a 66%  and  78%  Improvement  of 
the  SHIP  performance  criterion  and  a 49%  and  80%  Improvement  of  the  DINS 
performance  criterion  over  the  flight  test  #1  and  #2  trajectories,  respec- 
tively. Also,  the  full  covariance  of  the  error  In  estimating  the  RIMU 
and  ground  sensor  errors  has  been  generated  for  each  RIMU  and  for  each  of 
the  selected  trajectories. 
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APPENDIX  G 

FREE-FLIGHT  FILTERING 
G-l.  Measurement  Equations 

In  order  to  Improve  alignment  using  free-fllght  filtering,  the  attitude 
and  sensed  velocity  obtained  from  the  DINS  gyros  and  accelerometers  must 
be  compared  with  the  attitude  and  sensed  velocity  calculated  from  body 
dynamics.  Using  state  space  notation,  the  measurement  at  time  1 Is 
expressed  as 


where  the  measurement  6z  and  the  state  vector  fix  are  given  In  differential 
notation  to  Indicate  that  these  quantities  are  errors  about  the  nominal 
values. 

In  Figure  G-l,  the  free-fllght  filtering  state  vector  Is  given.  By  treat- 
ing the  position,  velocity,  and  alignment  errors  as  Initial  errors,  the 
entire  free-fllght  state  vector  consists  entirely  of  bias  states,  thus 
eliminating  the  need  for  performing  a time  propagation  between  measurement 
updates.  At  the  end  of  free-fllght  filtering,  the  contribution  of  DINS 
errors  to  the  present  position,  velocity,  and  alignment  errors  Is  easily 
calculated  and  added  to  the  state  vector.  In  practice,  the  G4G  errors  of 
Figure  G-l  are  not  Included  In  the  free-fllght  state  vector  since  they  do 
not  contribute  to  alignment  or  sensed  velocity  errors.  Their  contribution 
to  the  total  position  and  velocity  errors  Is  calculated  Independently  and 
Is  then  added  directly  to  the  position  and  velocity  errors  at  the  appropri- 
ate time. 

For  the  case  of  a combined  angle  and  sensed  velocity  update,  the  free- 
fllght  filtering  measurement  vector  Is  the  difference  between  the  DINS 
calculated  values  and  the  body  dynamics  calculated  values  and  Is  given 
by 
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Initial  ECI  position  and  velocity  wrror 

Initial  DINS  alignment  errors 

DINS  accelerometer  errors 

DINS  gyro  errors 

Body  dynamics  errors 

G&G  errors 


Figure  G-l.  Freeflight  Filtering  State  Vector 
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^0  INS  ‘ ^BO 
^0  INS  ‘ *80 

Each  Individual  term  can  be  expressed  as  the  sum  of  the  actual  value  plus 

an  error  term: 

|l 

^OINS  " ^Actual  * a^OINS  * 6^Quant  (r 

I ^80  " -Actual  * 4^BD 

1 SoiNS  ’ ^Actual  * 4§0INS  + 4*Quant 

■ SflO  “ ^Actual  + 4&B0 

' The  quantization  errors,  which  are  due  to  the  finite  Instrument  scale 

| factors,  are  separated  from  the  other  errors  In  these  equations.  Substl- 

* tutlng  equation  { G- 3)  Into  equation  (G»2),  the  measurement  equation 

| becomes 

P^OINS  “ 4^flO  + 6%ant 

| a*  • 

a&oiNS  ' 4SflO  + 4Squant 


Since  all  error  states  are  treated  as  bias  errors  here,  the  velocity  and 
allanment  errors  as  a function  of  time  are  olven  bv 
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Substituting  these  expressions  for  the  velocity  and  alignment  errors  Into 
equation  (G-4),  we  obtain 
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DINS  DINS  - 

^jSlM  h * k “550  -BD  + ^ -Quant 

-A  -G 


3i  ^D INS  . 31  rDlNS  - 36  „ , .. 

jjm  -A  * k T^0  ieo  + 5^uant 

-A  W*G 


(G-6) 


Comparing  equations  (G-l)  and  (G-6),  the  measurement  matrix  H Is  seen  to  be 
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and  the  measurement  noise  \>  Is  seen  to  be 
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^uant 


5^Quant 


(G-8) 


This  measurement  matrix  and  the  covariance  of  this  measurement  noise  are 
incorporated  Into  a Kalman  filter  (Appendix  C)  to  update  the  state  vector. 


G-2.  Body  Dynamics 

In  order  to  calculate  the  free-flight  filter  H matrix,  the  sensitivity  of 
velocity  and  angle  errors  to  the  error  state  vector  must  first  be  calcula- 
ted. The  sensitivity  to  the  DINS  error  state  is  obtained  from  the  DINS 
error  equations  (Section  3.2.3).  To  obtain  the  sensitivity  to  the  body 
dynamics  errors,  body  dynamics  error  equations  are  needed.  Before  deriv- 
ing the  body  dynamics  error  equations,  the  nominal  equations  for  calcula- 
ting attitude  and  sensed  velocity  will  be  presented. 

Euler's  equation,  modified  to  the  case  of  zero  external  torque,  can  be 
used  to  compute  the  RV  attitude  during  free-flight.  The  equation  Is 
written  as 


The  subscript  p indicates  that  these  quantities  are  to  be  calculated  In 
the  coordinate  frame  of  the  principal  axes  of  the  RV.  Brackets  are  used 
to  denote  matrix  (or  tensor)  operations,  and  the  symbol  [lupx]  corresponds 
to  the  matrix  which  results  in  the  Indicated  cross  product  operation. 

The  equation  for  sensed  velocity  Is  given  by 

^i,  ■*bx(3b  x Fb5  + ®b  xTb  (G’10) 

where  the  subscript  b Indicates  that  these  quantities  are  to  be  calculated 
In  a coordinate  frame  fixed  with  respect  to  the  body.  The  first  term  on 
the  right  hand  side  of  the  equation  Is  the  centripetal  acceleration.  As 
a result  of  the  coning  motion,  is  nonzero,  and  both  terms  on  the  right 
hand  side  of  the  equation  therefore  contribute  to  the  sensed  velocity. 

In  the  computer  simulation,  error  equations  for  body  dynamics  are  used  to 
compute  angle  and  sensed  velocity  errors  directly.  The  error  equations 
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are  obtained  by  taking  small  perturbations- about  the  nominal  body  dynamics 
equations  (G-9)  and  (G-10).  The  resulting  equations  are: 

4 - }L!*pn?p][I*p]  - x]|5Si  * MT[XH 

♦ mtuh[“i x]  - pi  *]!hts 

. _ (G-ll) 

5Vb  “ 2 f ■*‘B]  [(™I  x ‘ 

♦Mjfo  x][ffi  x3  +["i  x]iiFi 

where  ■ rate  error  in  Inertial  coordinates 

1 

- 5 ©’j  ■ alignment  error  In  inertial  coordinates 

■ sensed  velocity  error  In  body  coordinates 

[I-P]  » coordinate  transformation  from  inertial  to  principal 
axis  coordinates 

Cl -** B]  ■ coordinate  transformation  from  inertial  to  body 
coordinates 

■ enror  ^ magnitude  of  moment  Inertia  about  principal 
axes 

dip  ■ alignment  error  of  principal  axes 

9 

3uiq 

[X]  ■ — =•  ■ sensitivity  of  rate  error  derivative  about  Drincl- 
oal  axes  to  dr 


1*5  1 ■ ■ sensitivity  of  rate  error  derivative  about  prlnci- 

^ ^ 3wp  pal  axes  to  5wp 


G-6 


LOGICON 


i 

t 


r 


The  quantities  [X]  and  [?p]  can  be  calculated  in  a straightforward  manner 
from  equation  (G-9).  First,  we  write  the  equation  for  each  component  of 
the  vector  equation  separately: 


Since  the  matrix  [\]is  singular,  there  Is  some  linear  combination  of  the 
moment  of  inertia  states  that  is  nonobservable.  To  Improve  the  filter 
stability,  it  is  desirable  to  choose  a different  basis  in  which  one  of 
the  states  is  explicitly  nonobservable.  While  there  are  many  possible 
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It  Is  apparent  from  equation  ( G- 14 ) that  31^  Is  nonobservable,  This  is 
not  surprising  since  a change  In  the  value  of  5Im3  (51mj  and  61^  remain- 
ing constant)  corresponds  to  the  same  proportional  change  In  each  of  51  j, 
61 p2 • and  51  Since  Euler's  equation  does  not  depend  on  the  total  magni- 
tude of  the  moment  of  Inertia  but  only  on  the  relative  sizes  of  the  Indi- 
vidual components,  the  state  51^  does  not  affect  body  dynamics  and  Is 
thus  nonobservable. 


G-9 


i 

1 


LOGICON 


G-3.  Computer  Organization 

A flow  diagram  Indicating  the  computer  programs  used  In  free-flight  fil- 
tering Is  shown  Figure  G-2.  The  free-flight  simulation  program  FFS1M 
uses  quaternions  to  calculate  the  body  attitude  as  a function  of  time. 

To  calculate  the  vehicle  position  and  velocity,  FFS1M  employs  a spherical 
harmonic  expansion  of  the  earth's  gravitational  field.  The  body  dynamics 
program  80DYN  uses  the  error  equations  of  Section  G-2  to  calculate  the 
body  dynamics  measurement  matrices  as  a function  of  time,  while  the  linear 
error  analysis  program  LEAP  uses  the  DINS  error  model  of  Section  3. 2. 3.1 
to  calculate  the  DINS  transition  and  measurement  matrices  as  a function 
of  time.  The  system  error  analysis  program  SEAP  incorporates  the  LEAP 
and  BODYN  outputs  Into  a Kalman  filter  to  obtain  several  measures  of  the 
system  performance,  including  Inflight  alignment  performance  and  inflight 
calibration  performance  of  the  DINS  and  body  dynamics  error  sources. 
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Figure  G-2.  Freef light  Filtering  Computer  Prograa  Organization 


